blob: 2408502cf8ded8f010804af07ee94dece1845cf7 [file] [log] [blame]
James Feist22c257a2018-08-31 14:07:12 -07001/*
2// Copyright (c) 2018 Intel Corporation
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 "stepwisecontroller.hpp"
18
19#include "ec/stepwise.hpp"
James Feist734f9532018-11-15 12:13:18 -080020#include "errors/exception.hpp"
James Feist22c257a2018-08-31 14:07:12 -070021#include "util.hpp"
22#include "zone.hpp"
23
24#include <algorithm>
25#include <chrono>
James Feist3dfaafd2018-09-20 15:46:58 -070026#include <cmath>
James Feist22c257a2018-08-31 14:07:12 -070027#include <iostream>
28#include <map>
29#include <memory>
30#include <thread>
31#include <vector>
32
33void StepwiseController::process(void)
34{
35 // Get input value
Patrick Venture5f59c0f2018-11-11 12:55:14 -080036 double input = inputProc();
James Feist22c257a2018-08-31 14:07:12 -070037
James Feist3dfaafd2018-09-20 15:46:58 -070038 ec::StepwiseInfo info = get_stepwise_info();
James Feist22c257a2018-08-31 14:07:12 -070039
Patrick Venture5f59c0f2018-11-11 12:55:14 -080040 double output = lastOutput;
James Feist3dfaafd2018-09-20 15:46:58 -070041
42 // Calculate new output if hysteresis allows
43 if (std::isnan(output))
44 {
45 output = ec::stepwise(info, input);
46 lastInput = input;
47 }
48 else if ((input - lastInput) > info.positiveHysteresis)
49 {
50 output = ec::stepwise(info, input);
51 lastInput = input;
52 }
53 else if ((lastInput - input) > info.negativeHysteresis)
54 {
55 output = ec::stepwise(info, input);
56 lastInput = input;
57 }
58
59 lastOutput = output;
James Feist22c257a2018-08-31 14:07:12 -070060 // Output new value
Patrick Venture563a3562018-10-30 09:31:26 -070061 outputProc(output);
James Feist22c257a2018-08-31 14:07:12 -070062
63 return;
64}
65
Patrick Venture563a3562018-10-30 09:31:26 -070066std::unique_ptr<Controller> StepwiseController::createStepwiseController(
James Feist22c257a2018-08-31 14:07:12 -070067 ZoneInterface* owner, const std::string& id,
68 const std::vector<std::string>& inputs, const ec::StepwiseInfo& initial)
69{
James Feist734f9532018-11-15 12:13:18 -080070 // StepwiseController requires at least 1 input
71 if (inputs.empty())
James Feist22c257a2018-08-31 14:07:12 -070072 {
James Feist734f9532018-11-15 12:13:18 -080073 throw ControllerBuildException("Stepwise controller missing inputs");
James Feist22c257a2018-08-31 14:07:12 -070074 return nullptr;
75 }
76
77 auto thermal = std::make_unique<StepwiseController>(id, inputs, owner);
78
79 ec::StepwiseInfo& info = thermal->get_stepwise_info();
80
81 info = initial;
82
83 return thermal;
84}
85
Patrick Venture5f59c0f2018-11-11 12:55:14 -080086double StepwiseController::inputProc(void)
James Feist22c257a2018-08-31 14:07:12 -070087{
James Feist734f9532018-11-15 12:13:18 -080088 double value = std::numeric_limits<double>::lowest();
89 for (const auto& in : _inputs)
90 {
91 value = std::max(value, _owner->getCachedValue(in));
92 }
Patrick Venture5f59c0f2018-11-11 12:55:14 -080093 return value;
James Feist22c257a2018-08-31 14:07:12 -070094}
95
Patrick Venture5f59c0f2018-11-11 12:55:14 -080096void StepwiseController::outputProc(double value)
James Feist22c257a2018-08-31 14:07:12 -070097{
James Feist608304d2019-02-25 10:01:42 -080098 if (get_stepwise_info().isCeiling)
99 {
100 _owner->addRPMCeiling(value);
101 }
102 else
103 {
104 _owner->addRPMSetPoint(value);
105 }
James Feist22c257a2018-08-31 14:07:12 -0700106 return;
107}