1ce6a3f36SJames Feist /** 2ce6a3f36SJames Feist * Copyright 2017 Google Inc. 3ce6a3f36SJames Feist * 4ce6a3f36SJames Feist * Licensed under the Apache License, Version 2.0 (the "License"); 5ce6a3f36SJames Feist * you may not use this file except in compliance with the License. 6ce6a3f36SJames Feist * You may obtain a copy of the License at 7ce6a3f36SJames Feist * 8ce6a3f36SJames Feist * http://www.apache.org/licenses/LICENSE-2.0 9ce6a3f36SJames Feist * 10ce6a3f36SJames Feist * Unless required by applicable law or agreed to in writing, software 11ce6a3f36SJames Feist * distributed under the License is distributed on an "AS IS" BASIS, 12ce6a3f36SJames Feist * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13ce6a3f36SJames Feist * See the License for the specific language governing permissions and 14ce6a3f36SJames Feist * limitations under the License. 15ce6a3f36SJames Feist */ 16ce6a3f36SJames Feist 17ce6a3f36SJames Feist #include "pidloop.hpp" 18ce6a3f36SJames Feist 19ce6a3f36SJames Feist #include "pid/pidcontroller.hpp" 20ce6a3f36SJames Feist #include "pid/tuning.hpp" 217a98c19aSPatrick Venture #include "pid/zone_interface.hpp" 22ce6a3f36SJames Feist #include "sensors/sensor.hpp" 23ce6a3f36SJames Feist 24ce6a3f36SJames Feist #include <boost/asio/steady_timer.hpp> 25a83a3eccSPatrick Venture 26ce6a3f36SJames Feist #include <chrono> 27ce6a3f36SJames Feist #include <map> 28ce6a3f36SJames Feist #include <memory> 297a98c19aSPatrick Venture #include <sstream> 30ce6a3f36SJames Feist #include <thread> 31ce6a3f36SJames Feist #include <vector> 32ce6a3f36SJames Feist 33a076487aSPatrick Venture namespace pid_control 34a076487aSPatrick Venture { 35a076487aSPatrick Venture 36*5301aae3SJohnathan Mantey static void processThermals(std::shared_ptr<ZoneInterface> zone) 37ce6a3f36SJames Feist { 38ce6a3f36SJames Feist // Get the latest margins. 39ce6a3f36SJames Feist zone->updateSensors(); 409bbf333dSPatrick Venture // Zero out the set point goals. 419bbf333dSPatrick Venture zone->clearSetPoints(); 42ce6a3f36SJames Feist zone->clearRPMCeilings(); 43ce6a3f36SJames Feist // Run the margin PIDs. 44ce6a3f36SJames Feist zone->processThermals(); 45ce6a3f36SJames Feist // Get the maximum RPM setpoint. 46f7a2dd5cSPatrick Venture zone->determineMaxSetPointRequest(); 47ce6a3f36SJames Feist } 48ce6a3f36SJames Feist 49*5301aae3SJohnathan Mantey void pidControlLoop(std::shared_ptr<ZoneInterface> zone, 50*5301aae3SJohnathan Mantey std::shared_ptr<boost::asio::steady_timer> timer, 51597ebd67SPatrick Venture bool first, int ms100cnt) 52ce6a3f36SJames Feist { 53ce6a3f36SJames Feist if (first) 54ce6a3f36SJames Feist { 55de79ee05SPatrick Venture if (loggingEnabled) 56ce6a3f36SJames Feist { 57ce6a3f36SJames Feist zone->initializeLog(); 58ce6a3f36SJames Feist } 59ce6a3f36SJames Feist 60ce6a3f36SJames Feist zone->initializeCache(); 61ce6a3f36SJames Feist processThermals(zone); 62ce6a3f36SJames Feist } 63ce6a3f36SJames Feist 64*5301aae3SJohnathan Mantey timer->expires_after(std::chrono::milliseconds(100)); 65*5301aae3SJohnathan Mantey timer->async_wait( 66*5301aae3SJohnathan Mantey [zone, timer, ms100cnt](const boost::system::error_code& ec) mutable { 671fe08952SJames Feist if (ec == boost::asio::error::operation_aborted) 681fe08952SJames Feist { 691fe08952SJames Feist return; // timer being canceled, stop loop 701fe08952SJames Feist } 711fe08952SJames Feist 72ce6a3f36SJames Feist /* 73ce6a3f36SJames Feist * This should sleep on the conditional wait for the listen thread 74ce6a3f36SJames Feist * to tell us it's in sync. But then we also need a timeout option 75ce6a3f36SJames Feist * in case phosphor-hwmon is down, we can go into some weird failure 76ce6a3f36SJames Feist * more. 77ce6a3f36SJames Feist * 78ce6a3f36SJames Feist * Another approach would be to start all sensors in worst-case 79ce6a3f36SJames Feist * values, and fail-safe mode and then clear out of fail-safe mode 80ce6a3f36SJames Feist * once we start getting values. Which I think it is a solid 81ce6a3f36SJames Feist * approach. 82ce6a3f36SJames Feist * 83ce6a3f36SJames Feist * For now this runs before it necessarily has any sensor values. 84ce6a3f36SJames Feist * For the host sensors they start out in fail-safe mode. For the 85ce6a3f36SJames Feist * fans, they start out as 0 as input and then are adjusted once 86ce6a3f36SJames Feist * they have values. 87ce6a3f36SJames Feist * 88ce6a3f36SJames Feist * If a fan has failed, it's value will be whatever we're told or 89ce6a3f36SJames Feist * however we retrieve it. This program disregards fan values of 0, 90ce6a3f36SJames Feist * so any code providing a fan speed can set to 0 on failure and 91ce6a3f36SJames Feist * that fan value will be effectively ignored. The PID algorithm 92ce6a3f36SJames Feist * will be unhappy but nothing bad will happen. 93ce6a3f36SJames Feist * 94ce6a3f36SJames Feist * TODO(venture): If the fan value is 0 should that loop just be 95ce6a3f36SJames Feist * skipped? Right now, a 0 value is ignored in 96ce6a3f36SJames Feist * FanController::inputProc() 97ce6a3f36SJames Feist */ 98ce6a3f36SJames Feist 99ce6a3f36SJames Feist // Check if we should just go back to sleep. 100ce6a3f36SJames Feist if (zone->getManualMode()) 101ce6a3f36SJames Feist { 102ce6a3f36SJames Feist pidControlLoop(zone, timer, false, ms100cnt); 103ce6a3f36SJames Feist return; 104ce6a3f36SJames Feist } 105ce6a3f36SJames Feist 106ce6a3f36SJames Feist // Get the latest fan speeds. 107ce6a3f36SJames Feist zone->updateFanTelemetry(); 108ce6a3f36SJames Feist 109ce6a3f36SJames Feist if (10 <= ms100cnt) 110ce6a3f36SJames Feist { 111ce6a3f36SJames Feist ms100cnt = 0; 112ce6a3f36SJames Feist 113ce6a3f36SJames Feist processThermals(zone); 114ce6a3f36SJames Feist } 115ce6a3f36SJames Feist 116ce6a3f36SJames Feist // Run the fan PIDs every iteration. 117ce6a3f36SJames Feist zone->processFans(); 118ce6a3f36SJames Feist 119de79ee05SPatrick Venture if (loggingEnabled) 120ce6a3f36SJames Feist { 1217a98c19aSPatrick Venture std::ostringstream out; 1227a98c19aSPatrick Venture out << "," << zone->getFailSafeMode() << std::endl; 1237a98c19aSPatrick Venture zone->writeLog(out.str()); 124ce6a3f36SJames Feist } 125ce6a3f36SJames Feist 126ce6a3f36SJames Feist ms100cnt += 1; 127ce6a3f36SJames Feist 128ce6a3f36SJames Feist pidControlLoop(zone, timer, false, ms100cnt); 129ce6a3f36SJames Feist }); 130ce6a3f36SJames Feist } 131a076487aSPatrick Venture 132a076487aSPatrick Venture } // namespace pid_control 133