removed core component
This commit is contained in:
parent
14e254141c
commit
ff62ab8427
@ -1,257 +0,0 @@
|
|||||||
#include "CoreComponent.h"
|
|
||||||
|
|
||||||
CoreComponent::CoreComponent(object_id_t reportingObjectId, uint8_t domainId,
|
|
||||||
uint32_t temperaturePoolId, uint32_t targetStatePoolId,
|
|
||||||
uint32_t currentStatePoolId, uint32_t requestPoolId, GlobDataSet* dataSet,
|
|
||||||
AbstractTemperatureSensor* sensor,
|
|
||||||
AbstractTemperatureSensor* firstRedundantSensor,
|
|
||||||
AbstractTemperatureSensor* secondRedundantSensor,
|
|
||||||
ThermalModuleIF* thermalModule, Parameters parameters,
|
|
||||||
Priority priority, StateRequest initialTargetState) :
|
|
||||||
sensor(sensor), firstRedundantSensor(firstRedundantSensor), secondRedundantSensor(
|
|
||||||
secondRedundantSensor), thermalModule(thermalModule), temperature(
|
|
||||||
temperaturePoolId, dataSet, PoolVariableIF::VAR_WRITE), targetState(
|
|
||||||
targetStatePoolId, dataSet, PoolVariableIF::VAR_READ), currentState(
|
|
||||||
currentStatePoolId, dataSet, PoolVariableIF::VAR_WRITE), heaterRequest(
|
|
||||||
requestPoolId, dataSet, PoolVariableIF::VAR_WRITE), isHeating(
|
|
||||||
false), isSafeComponent(priority == SAFE), minTemp(999), maxTemp(
|
|
||||||
AbstractTemperatureSensor::ZERO_KELVIN_C), parameters(
|
|
||||||
parameters), temperatureMonitor(reportingObjectId,
|
|
||||||
domainId + 1,
|
|
||||||
GlobalDataPool::poolIdAndPositionToPid(temperaturePoolId, 0),
|
|
||||||
COMPONENT_TEMP_CONFIRMATION), domainId(domainId) {
|
|
||||||
if (thermalModule != NULL) {
|
|
||||||
thermalModule->registerComponent(this, priority);
|
|
||||||
}
|
|
||||||
//Set thermal state once, then leave to operator.
|
|
||||||
GlobDataSet mySet;
|
|
||||||
gp_uint8_t writableTargetState(targetStatePoolId, &mySet,
|
|
||||||
PoolVariableIF::VAR_WRITE);
|
|
||||||
writableTargetState = initialTargetState;
|
|
||||||
mySet.commit(PoolVariableIF::VALID);
|
|
||||||
}
|
|
||||||
|
|
||||||
CoreComponent::~CoreComponent() {
|
|
||||||
}
|
|
||||||
|
|
||||||
ThermalComponentIF::HeaterRequest CoreComponent::performOperation(uint8_t opCode) {
|
|
||||||
HeaterRequest request = HEATER_DONT_CARE;
|
|
||||||
//SHOULDDO: Better pass db_float_t* to getTemperature and set it invalid if invalid.
|
|
||||||
temperature = getTemperature();
|
|
||||||
updateMinMaxTemp();
|
|
||||||
if ((temperature != INVALID_TEMPERATURE)) {
|
|
||||||
temperature.setValid(PoolVariableIF::VALID);
|
|
||||||
State state = getState(temperature, getParameters(), targetState);
|
|
||||||
currentState = state;
|
|
||||||
checkLimits(state);
|
|
||||||
request = getHeaterRequest(targetState, temperature, getParameters());
|
|
||||||
} else {
|
|
||||||
temperatureMonitor.setToInvalid();
|
|
||||||
temperature.setValid(PoolVariableIF::INVALID);
|
|
||||||
currentState = UNKNOWN;
|
|
||||||
request = HEATER_DONT_CARE;
|
|
||||||
}
|
|
||||||
currentState.setValid(PoolVariableIF::VALID);
|
|
||||||
heaterRequest = request;
|
|
||||||
heaterRequest.setValid(PoolVariableIF::VALID);
|
|
||||||
return request;
|
|
||||||
}
|
|
||||||
|
|
||||||
void CoreComponent::markStateIgnored() {
|
|
||||||
currentState = getIgnoredState(currentState);
|
|
||||||
}
|
|
||||||
|
|
||||||
object_id_t CoreComponent::getObjectId() {
|
|
||||||
return temperatureMonitor.getReporterId();
|
|
||||||
}
|
|
||||||
|
|
||||||
float CoreComponent::getLowerOpLimit() {
|
|
||||||
return parameters.lowerOpLimit;
|
|
||||||
}
|
|
||||||
|
|
||||||
ReturnValue_t CoreComponent::setTargetState(int8_t newState) {
|
|
||||||
GlobDataSet mySet;
|
|
||||||
gp_uint8_t writableTargetState(targetState.getDataPoolId(),
|
|
||||||
&mySet, PoolVariableIF::VAR_READ_WRITE);
|
|
||||||
mySet.read();
|
|
||||||
if ((writableTargetState == STATE_REQUEST_OPERATIONAL)
|
|
||||||
&& (newState != STATE_REQUEST_IGNORE)) {
|
|
||||||
return HasReturnvaluesIF::RETURN_FAILED;
|
|
||||||
}
|
|
||||||
switch (newState) {
|
|
||||||
case STATE_REQUEST_HEATING:
|
|
||||||
case STATE_REQUEST_IGNORE:
|
|
||||||
case STATE_REQUEST_OPERATIONAL:
|
|
||||||
writableTargetState = newState;
|
|
||||||
break;
|
|
||||||
case STATE_REQUEST_NON_OPERATIONAL:
|
|
||||||
default:
|
|
||||||
return INVALID_TARGET_STATE;
|
|
||||||
}
|
|
||||||
mySet.commit(PoolVariableIF::VALID);
|
|
||||||
return HasReturnvaluesIF::RETURN_OK;
|
|
||||||
}
|
|
||||||
|
|
||||||
void CoreComponent::setOutputInvalid() {
|
|
||||||
temperature = INVALID_TEMPERATURE;
|
|
||||||
temperature.setValid(PoolVariableIF::INVALID);
|
|
||||||
currentState.setValid(PoolVariableIF::INVALID);
|
|
||||||
heaterRequest = HEATER_DONT_CARE;
|
|
||||||
heaterRequest.setValid(PoolVariableIF::INVALID);
|
|
||||||
temperatureMonitor.setToUnchecked();
|
|
||||||
}
|
|
||||||
|
|
||||||
float CoreComponent::getTemperature() {
|
|
||||||
if ((sensor != NULL) && (sensor->isValid())) {
|
|
||||||
return sensor->getTemperature();
|
|
||||||
}
|
|
||||||
|
|
||||||
if ((firstRedundantSensor != NULL) && (firstRedundantSensor->isValid())) {
|
|
||||||
return firstRedundantSensor->getTemperature();
|
|
||||||
}
|
|
||||||
|
|
||||||
if ((secondRedundantSensor != NULL) && (secondRedundantSensor->isValid())) {
|
|
||||||
return secondRedundantSensor->getTemperature();
|
|
||||||
}
|
|
||||||
|
|
||||||
if (thermalModule != NULL) {
|
|
||||||
float temperature = thermalModule->getTemperature();
|
|
||||||
if (temperature != ThermalModuleIF::INVALID_TEMPERATURE) {
|
|
||||||
return temperature;
|
|
||||||
} else {
|
|
||||||
return INVALID_TEMPERATURE;
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
return INVALID_TEMPERATURE;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
ThermalComponentIF::State CoreComponent::getState(float temperature,
|
|
||||||
Parameters parameters, int8_t targetState) {
|
|
||||||
ThermalComponentIF::State state;
|
|
||||||
|
|
||||||
if (temperature < parameters.lowerOpLimit) {
|
|
||||||
state = NON_OPERATIONAL_LOW;
|
|
||||||
} else if (temperature < parameters.upperOpLimit) {
|
|
||||||
state = OPERATIONAL;
|
|
||||||
} else {
|
|
||||||
state = NON_OPERATIONAL_HIGH;
|
|
||||||
}
|
|
||||||
if (targetState == STATE_REQUEST_IGNORE) {
|
|
||||||
state = getIgnoredState(state);
|
|
||||||
}
|
|
||||||
|
|
||||||
return state;
|
|
||||||
}
|
|
||||||
|
|
||||||
void CoreComponent::checkLimits(ThermalComponentIF::State state) {
|
|
||||||
//Checks operational limits only.
|
|
||||||
temperatureMonitor.translateState(state, temperature.value,
|
|
||||||
getParameters().lowerOpLimit, getParameters().upperOpLimit);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
ThermalComponentIF::HeaterRequest CoreComponent::getHeaterRequest(
|
|
||||||
int8_t targetState, float temperature, Parameters parameters) {
|
|
||||||
if (targetState == STATE_REQUEST_IGNORE) {
|
|
||||||
isHeating = false;
|
|
||||||
return HEATER_DONT_CARE;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (temperature > parameters.upperOpLimit - parameters.heaterSwitchoff) {
|
|
||||||
isHeating = false;
|
|
||||||
return HEATER_REQUEST_EMERGENCY_OFF;
|
|
||||||
}
|
|
||||||
|
|
||||||
float opHeaterLimit = parameters.lowerOpLimit + parameters.heaterOn;
|
|
||||||
|
|
||||||
if (isHeating) {
|
|
||||||
opHeaterLimit += parameters.hysteresis;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (temperature < opHeaterLimit) {
|
|
||||||
isHeating = true;
|
|
||||||
return HEATER_REQUEST_EMERGENCY_ON;
|
|
||||||
}
|
|
||||||
isHeating = false;
|
|
||||||
return HEATER_DONT_CARE;
|
|
||||||
}
|
|
||||||
|
|
||||||
ThermalComponentIF::State CoreComponent::getIgnoredState(int8_t state) {
|
|
||||||
switch (state) {
|
|
||||||
case NON_OPERATIONAL_LOW:
|
|
||||||
return NON_OPERATIONAL_LOW_IGNORED;
|
|
||||||
case OPERATIONAL:
|
|
||||||
return OPERATIONAL_IGNORED;
|
|
||||||
case NON_OPERATIONAL_HIGH:
|
|
||||||
return NON_OPERATIONAL_HIGH_IGNORED;
|
|
||||||
case NON_OPERATIONAL_LOW_IGNORED:
|
|
||||||
return NON_OPERATIONAL_LOW_IGNORED;
|
|
||||||
case OPERATIONAL_IGNORED:
|
|
||||||
return OPERATIONAL_IGNORED;
|
|
||||||
case NON_OPERATIONAL_HIGH_IGNORED:
|
|
||||||
return NON_OPERATIONAL_HIGH_IGNORED;
|
|
||||||
default:
|
|
||||||
case UNKNOWN:
|
|
||||||
return UNKNOWN;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void CoreComponent::updateMinMaxTemp() {
|
|
||||||
if (temperature == INVALID_TEMPERATURE) {
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
if (temperature < minTemp) {
|
|
||||||
minTemp = temperature;
|
|
||||||
}
|
|
||||||
if (temperature > maxTemp) {
|
|
||||||
maxTemp = temperature;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t CoreComponent::getDomainId() const {
|
|
||||||
return domainId;
|
|
||||||
}
|
|
||||||
|
|
||||||
CoreComponent::Parameters CoreComponent::getParameters() {
|
|
||||||
return parameters;
|
|
||||||
}
|
|
||||||
|
|
||||||
ReturnValue_t CoreComponent::getParameter(uint8_t domainId,
|
|
||||||
uint16_t parameterId, ParameterWrapper* parameterWrapper,
|
|
||||||
const ParameterWrapper* newValues, uint16_t startAtIndex) {
|
|
||||||
ReturnValue_t result = temperatureMonitor.getParameter(domainId,
|
|
||||||
parameterId, parameterWrapper, newValues, startAtIndex);
|
|
||||||
if (result != INVALID_DOMAIN_ID) {
|
|
||||||
return result;
|
|
||||||
}
|
|
||||||
if (domainId != this->domainId) {
|
|
||||||
return INVALID_DOMAIN_ID;
|
|
||||||
}
|
|
||||||
switch (parameterId) {
|
|
||||||
case 0:
|
|
||||||
parameterWrapper->set(parameters.heaterOn);
|
|
||||||
break;
|
|
||||||
case 1:
|
|
||||||
parameterWrapper->set(parameters.hysteresis);
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
parameterWrapper->set(parameters.heaterSwitchoff);
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
parameterWrapper->set(minTemp);
|
|
||||||
break;
|
|
||||||
case 4:
|
|
||||||
parameterWrapper->set(maxTemp);
|
|
||||||
break;
|
|
||||||
case 10:
|
|
||||||
parameterWrapper->set(parameters.lowerOpLimit);
|
|
||||||
break;
|
|
||||||
case 11:
|
|
||||||
parameterWrapper->set(parameters.upperOpLimit);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
return INVALID_MATRIX_ID;
|
|
||||||
}
|
|
||||||
return HasReturnvaluesIF::RETURN_OK;
|
|
||||||
}
|
|
||||||
@ -1,96 +0,0 @@
|
|||||||
#ifndef MISSION_CONTROLLERS_TCS_CORECOMPONENT_H_
|
|
||||||
#define MISSION_CONTROLLERS_TCS_CORECOMPONENT_H_
|
|
||||||
|
|
||||||
#include "../datapoolglob/GlobalDataSet.h"
|
|
||||||
#include "../datapoolglob/GlobalPoolVariable.h"
|
|
||||||
#include "../thermal/ThermalComponentIF.h"
|
|
||||||
#include "../thermal/AbstractTemperatureSensor.h"
|
|
||||||
#include "../thermal/ThermalModule.h"
|
|
||||||
#include "../thermal/ThermalMonitor.h"
|
|
||||||
|
|
||||||
// TODO: Documentaiton, how to use this? only use Thermal Component, which inherits core component?
|
|
||||||
class CoreComponent: public ThermalComponentIF {
|
|
||||||
public:
|
|
||||||
struct Parameters {
|
|
||||||
float lowerOpLimit;
|
|
||||||
float upperOpLimit;
|
|
||||||
float heaterOn;
|
|
||||||
float hysteresis;
|
|
||||||
float heaterSwitchoff;
|
|
||||||
};
|
|
||||||
|
|
||||||
static const uint16_t COMPONENT_TEMP_CONFIRMATION = 5;
|
|
||||||
|
|
||||||
CoreComponent(object_id_t reportingObjectId, uint8_t domainId, uint32_t temperaturePoolId,
|
|
||||||
uint32_t targetStatePoolId, uint32_t currentStatePoolId,
|
|
||||||
uint32_t requestPoolId, GlobDataSet *dataSet,
|
|
||||||
AbstractTemperatureSensor *sensor,
|
|
||||||
AbstractTemperatureSensor *firstRedundantSensor,
|
|
||||||
AbstractTemperatureSensor *secondRedundantSensor,
|
|
||||||
ThermalModuleIF *thermalModule, Parameters parameters,
|
|
||||||
Priority priority, StateRequest initialTargetState =
|
|
||||||
ThermalComponentIF::STATE_REQUEST_OPERATIONAL);
|
|
||||||
|
|
||||||
virtual ~CoreComponent();
|
|
||||||
|
|
||||||
virtual HeaterRequest performOperation(uint8_t opCode);
|
|
||||||
|
|
||||||
void markStateIgnored();
|
|
||||||
|
|
||||||
object_id_t getObjectId();
|
|
||||||
|
|
||||||
uint8_t getDomainId() const;
|
|
||||||
|
|
||||||
virtual float getLowerOpLimit();
|
|
||||||
|
|
||||||
ReturnValue_t setTargetState(int8_t newState);
|
|
||||||
|
|
||||||
virtual void setOutputInvalid();
|
|
||||||
|
|
||||||
virtual ReturnValue_t getParameter(uint8_t domainId, uint16_t parameterId,
|
|
||||||
ParameterWrapper *parameterWrapper,
|
|
||||||
const ParameterWrapper *newValues, uint16_t startAtIndex);
|
|
||||||
|
|
||||||
protected:
|
|
||||||
|
|
||||||
AbstractTemperatureSensor *sensor;
|
|
||||||
AbstractTemperatureSensor *firstRedundantSensor;
|
|
||||||
AbstractTemperatureSensor *secondRedundantSensor;
|
|
||||||
ThermalModuleIF *thermalModule;
|
|
||||||
|
|
||||||
gp_float_t temperature;
|
|
||||||
gp_int8_t targetState;
|
|
||||||
gp_int8_t currentState;
|
|
||||||
gp_uint8_t heaterRequest;
|
|
||||||
|
|
||||||
bool isHeating;
|
|
||||||
|
|
||||||
bool isSafeComponent;
|
|
||||||
|
|
||||||
float minTemp;
|
|
||||||
|
|
||||||
float maxTemp;
|
|
||||||
|
|
||||||
Parameters parameters;
|
|
||||||
|
|
||||||
ThermalMonitor temperatureMonitor;
|
|
||||||
|
|
||||||
const uint8_t domainId;
|
|
||||||
|
|
||||||
virtual float getTemperature();
|
|
||||||
virtual State getState(float temperature, Parameters parameters,
|
|
||||||
int8_t targetState);
|
|
||||||
|
|
||||||
virtual void checkLimits(State state);
|
|
||||||
|
|
||||||
virtual HeaterRequest getHeaterRequest(int8_t targetState,
|
|
||||||
float temperature, Parameters parameters);
|
|
||||||
|
|
||||||
virtual State getIgnoredState(int8_t state);
|
|
||||||
|
|
||||||
void updateMinMaxTemp();
|
|
||||||
|
|
||||||
virtual Parameters getParameters();
|
|
||||||
};
|
|
||||||
|
|
||||||
#endif /* MISSION_CONTROLLERS_TCS_CORECOMPONENT_H_ */
|
|
||||||
Loading…
Reference in New Issue
Block a user