blob: aba2b6e7843ca34ca6cfa105d83367b71583c47b [file] [log] [blame]
James Feistce6a3f32019-03-12 11:20:16 -07001/**
2 * Copyright 2017 Google Inc.
3 *
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
7 *
8 * http://www.apache.org/licenses/LICENSE-2.0
9 *
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 */
16
17#include "pidloop.hpp"
18
19#include "pid/pidcontroller.hpp"
20#include "pid/tuning.hpp"
Patrick Venture7a98c192020-08-12 08:35:16 -070021#include "pid/zone_interface.hpp"
James Feistce6a3f32019-03-12 11:20:16 -070022#include "sensors/sensor.hpp"
23
24#include <boost/asio/steady_timer.hpp>
Patrick Venturea83a3ec2020-08-04 09:52:05 -070025
James Feistce6a3f32019-03-12 11:20:16 -070026#include <chrono>
27#include <map>
28#include <memory>
Patrick Venture7a98c192020-08-12 08:35:16 -070029#include <sstream>
James Feistce6a3f32019-03-12 11:20:16 -070030#include <thread>
31#include <vector>
32
Patrick Venturea0764872020-08-08 07:48:43 -070033namespace pid_control
34{
35
Johnathan Mantey5301aae2020-09-28 11:06:58 -070036static void processThermals(std::shared_ptr<ZoneInterface> zone)
James Feistce6a3f32019-03-12 11:20:16 -070037{
38 // Get the latest margins.
39 zone->updateSensors();
Patrick Venture9bbf3332019-07-16 10:50:37 -070040 // Zero out the set point goals.
41 zone->clearSetPoints();
James Feistce6a3f32019-03-12 11:20:16 -070042 zone->clearRPMCeilings();
43 // Run the margin PIDs.
44 zone->processThermals();
45 // Get the maximum RPM setpoint.
Patrick Venturef7a2dd52019-07-16 14:31:13 -070046 zone->determineMaxSetPointRequest();
James Feistce6a3f32019-03-12 11:20:16 -070047}
48
Johnathan Mantey5301aae2020-09-28 11:06:58 -070049void pidControlLoop(std::shared_ptr<ZoneInterface> zone,
50 std::shared_ptr<boost::asio::steady_timer> timer,
Bonnie Lo0e8fc392022-10-05 10:20:55 +080051 const bool* isCanceling, bool first, uint64_t cycleCnt)
James Feistce6a3f32019-03-12 11:20:16 -070052{
Hao Jiangb6a0b892021-02-21 18:00:45 -080053 if (*isCanceling)
54 return;
55
James Feistce6a3f32019-03-12 11:20:16 -070056 if (first)
57 {
Patrick Venturede79ee02019-05-08 14:50:00 -070058 if (loggingEnabled)
James Feistce6a3f32019-03-12 11:20:16 -070059 {
60 zone->initializeLog();
61 }
62
63 zone->initializeCache();
64 processThermals(zone);
65 }
66
Bonnie Lo0e8fc392022-10-05 10:20:55 +080067 timer->expires_after(
68 std::chrono::milliseconds(zone->getCycleIntervalTime()));
69 timer->async_wait([zone, timer, cycleCnt, isCanceling](
Hao Jiangb6a0b892021-02-21 18:00:45 -080070 const boost::system::error_code& ec) mutable {
71 if (ec == boost::asio::error::operation_aborted)
72 {
73 return; // timer being canceled, stop loop
74 }
James Feist1fe08952019-05-07 09:17:16 -070075
Hao Jiangb6a0b892021-02-21 18:00:45 -080076 /*
77 * This should sleep on the conditional wait for the listen thread
78 * to tell us it's in sync. But then we also need a timeout option
79 * in case phosphor-hwmon is down, we can go into some weird failure
80 * more.
81 *
82 * Another approach would be to start all sensors in worst-case
83 * values, and fail-safe mode and then clear out of fail-safe mode
84 * once we start getting values. Which I think it is a solid
85 * approach.
86 *
87 * For now this runs before it necessarily has any sensor values.
88 * For the host sensors they start out in fail-safe mode. For the
89 * fans, they start out as 0 as input and then are adjusted once
90 * they have values.
91 *
92 * If a fan has failed, it's value will be whatever we're told or
93 * however we retrieve it. This program disregards fan values of 0,
94 * so any code providing a fan speed can set to 0 on failure and
95 * that fan value will be effectively ignored. The PID algorithm
96 * will be unhappy but nothing bad will happen.
97 *
98 * TODO(venture): If the fan value is 0 should that loop just be
99 * skipped? Right now, a 0 value is ignored in
100 * FanController::inputProc()
101 */
James Feistce6a3f32019-03-12 11:20:16 -0700102
Hao Jiangb6a0b892021-02-21 18:00:45 -0800103 // Check if we should just go back to sleep.
104 if (zone->getManualMode())
105 {
Bonnie Lo0e8fc392022-10-05 10:20:55 +0800106 pidControlLoop(zone, timer, isCanceling, false, cycleCnt);
Hao Jiangb6a0b892021-02-21 18:00:45 -0800107 return;
108 }
James Feistce6a3f32019-03-12 11:20:16 -0700109
Hao Jiangb6a0b892021-02-21 18:00:45 -0800110 // Get the latest fan speeds.
111 zone->updateFanTelemetry();
James Feistce6a3f32019-03-12 11:20:16 -0700112
Bonnie Lo0e8fc392022-10-05 10:20:55 +0800113 if (zone->getUpdateThermalsCycle() <= cycleCnt)
Hao Jiangb6a0b892021-02-21 18:00:45 -0800114 {
Bonnie Lo0e8fc392022-10-05 10:20:55 +0800115 cycleCnt = 0;
James Feistce6a3f32019-03-12 11:20:16 -0700116
Hao Jiangb6a0b892021-02-21 18:00:45 -0800117 processThermals(zone);
118 }
James Feistce6a3f32019-03-12 11:20:16 -0700119
Hao Jiangb6a0b892021-02-21 18:00:45 -0800120 // Run the fan PIDs every iteration.
121 zone->processFans();
James Feistce6a3f32019-03-12 11:20:16 -0700122
Hao Jiangb6a0b892021-02-21 18:00:45 -0800123 if (loggingEnabled)
124 {
125 std::ostringstream out;
126 out << "," << zone->getFailSafeMode() << std::endl;
127 zone->writeLog(out.str());
128 }
James Feistce6a3f32019-03-12 11:20:16 -0700129
Bonnie Lo0e8fc392022-10-05 10:20:55 +0800130 cycleCnt += 1;
James Feistce6a3f32019-03-12 11:20:16 -0700131
Bonnie Lo0e8fc392022-10-05 10:20:55 +0800132 pidControlLoop(zone, timer, isCanceling, false, cycleCnt);
Hao Jiangb6a0b892021-02-21 18:00:45 -0800133 });
James Feistce6a3f32019-03-12 11:20:16 -0700134}
Patrick Venturea0764872020-08-08 07:48:43 -0700135
136} // namespace pid_control