eive/eive-obsw
13
4
Fork 0
Code Issues 4 Pull Requests 1 Releases 121 Wiki Activity

changes thermal controller
All checks were successful
EIVE/eive-obsw/pipeline/pr-develop This commit looks good
Details

Browse Source
This commit is contained in:
Irini Kosmidou
2022-12-13 12:08:53 +01:00
parent b89e440fc4
commit 0b1136ad28
4 changed files with 131 additions and 29 deletions
Download Patch File Download Diff File Expand all files Collapse all files

127
mission/controller/ThermalController.cpp
View File

@ -105,7 +105,7 @@ void ThermalController::performControlOperation() {
}
// TODO: Heater control
ctrl4KCamera();
ctrlCameraBody();
}
ReturnValue_t ThermalController::initializeLocalDataPool(localpool::DataPool& localDataPoolMap,
@ -953,36 +953,111 @@ void ThermalController::copyDevices() {
}
}
void ThermalController::ctrl4KCamera() {
// 4K Camera
float cameraTemp;
void ThermalController::ctrlMgt() {
float sensorTemp;
float opLowerLimit = mgtLimits.opLowerLimit;
float cutOffLimit = mgtLimits.cutOffLimit;
heater::Switchers switchNr = heater::HEATER_2_ACS_BRD;
heater::Switchers redSwitchNr = heater::HEATER_3_PCDU_PDU;
bool cameraTempAvailable = true;
bool heaterAvailable = true;
bool redSwitchNrInUse = false;
if (sensorTemperatures.sensor_4k_camera.isValid()) {
cameraTemp = sensorTemperatures.sensor_4k_camera.value;
} else if (sensorTemperatures.sensor_dro.isValid()) {
cameraTemp = sensorTemperatures.sensor_dro.value;
} else if (sensorTemperatures.sensor_mpa.isValid()) {
cameraTemp = sensorTemperatures.sensor_mpa.value;
} else {
if (heaterHandler.checkSwitchState(heater::HEATER_4_CAMERA)) {
heaterHandler.switchHeater(heater::HEATER_4_CAMERA, HeaterHandler::SwitchState::OFF);
// Choose Heater
chooseHeater(switchNr, redSwitchNr, redSwitchNrInUse, heaterAvailable);
if (heaterAvailable) {
// Choose sensor
if (sensorTemperatures.sensor_magnettorquer.isValid()) {
sensorTemp = sensorTemperatures.sensor_magnettorquer.value;
} else if (sensorTemperatures.sensor_magnettorquer.isValid()) { // TODO: int sensor
sensorTemp = sensorTemperatures.sensor_magnettorquer.value;
} else if (sensorTemperatures.sensor_plpcdu_heatspreader.isValid()) {
sensorTemp = sensorTemperatures.sensor_plpcdu_heatspreader.value;
} else {
if (heaterHandler.checkSwitchState(switchNr)) {
heaterHandler.switchHeater(switchNr, HeaterHandler::SwitchState::OFF);
}
triggerEvent(NO_VALID_SENSOR_TEMPERATURE, switchNr);
cameraTempAvailable = false;
}
triggerEvent(NO_VALID_SENSOR_TEMPERATURE, heater::HEATER_4_CAMERA);
cameraTempAvailable = false;
}
// TODO: include redundant heater
if (cameraTempAvailable) {
if (not heaterHandler.checkSwitchState(heater::HEATER_4_CAMERA)) {
// TODO: check if op or nop
if (cameraTemp < cameraLimits.opLowerLimit) {
heaterHandler.switchHeater(heater::HEATER_4_CAMERA, HeaterHandler::SwitchState::ON);
} else if (heaterHandler.checkSwitchState(heater::HEATER_4_CAMERA)) {
if (cameraTemp >= cameraLimits.opLowerLimit + TEMP_OFFSET) {
heaterHandler.switchHeater(heater::HEATER_4_CAMERA, HeaterHandler::SwitchState::OFF);
}
// Thermal Control
if (cameraTempAvailable) {
ctrlHeater(switchNr, redSwitchNr, redSwitchNrInUse, sensorTemp, opLowerLimit, cutOffLimit);
}
}
}
void ThermalController::ctrlCameraBody() {
// Camera Body
float sensorTemp;
float opLowerLimit = cameraLimits.opLowerLimit;
float cutOffLimit = cameraLimits.cutOffLimit;
heater::Switchers switchNr = heater::HEATER_4_CAMERA;
heater::Switchers redSwitchNr = heater::HEATER_6_DRO;
bool cameraTempAvailable = true;
bool heaterAvailable = true;
bool redSwitchNrInUse = false;
// Choose Heater
chooseHeater(switchNr, redSwitchNr, redSwitchNrInUse, heaterAvailable);
if (heaterAvailable) {
// Choose sensor
if (sensorTemperatures.sensor_4k_camera.isValid()) {
sensorTemp = sensorTemperatures.sensor_4k_camera.value;
} else if (sensorTemperatures.sensor_dro.isValid()) {
sensorTemp = sensorTemperatures.sensor_dro.value;
} else if (sensorTemperatures.sensor_mpa.isValid()) {
sensorTemp = sensorTemperatures.sensor_mpa.value;
} else {
if (heaterHandler.checkSwitchState(switchNr)) {
heaterHandler.switchHeater(switchNr, HeaterHandler::SwitchState::OFF);
}
triggerEvent(NO_VALID_SENSOR_TEMPERATURE, switchNr);
cameraTempAvailable = false;
}
// Thermal Control
if (cameraTempAvailable) {
ctrlHeater(switchNr, redSwitchNr, redSwitchNrInUse, sensorTemp, opLowerLimit, cutOffLimit);
}
}
}
void ThermalController::ctrlHeater(heater::Switchers switchNr, heater::Switchers redSwitchNr,
bool redSwitchNrInUse, float sensorTemp, float opLowerLimit,
float cutOffLimit) {
// Heater off
if (not heaterHandler.checkSwitchState(switchNr)) {
// TODO: check if OP or NOP
if (sensorTemp < opLowerLimit) {
heaterHandler.switchHeater(switchNr, HeaterHandler::SwitchState::ON);
}
// Heater on
} else if (heaterHandler.checkSwitchState(switchNr)) {
if (sensorTemp >= opLowerLimit + TEMP_OFFSET) {
heaterHandler.switchHeater(switchNr, HeaterHandler::SwitchState::OFF);
}
} else if (not redSwitchNrInUse) {
if (heaterHandler.checkSwitchState(redSwitchNr)) {
if (sensorTemp >= cutOffLimit) {
heaterHandler.switchHeater(redSwitchNr, HeaterHandler::SwitchState::OFF);
}
}
}
}
void ThermalController::chooseHeater(heater::Switchers switchNr, heater::Switchers redSwitchNr,
bool& redSwitchNrInUse, bool& heaterAvailable) {
// Choose Heater
if (heaterHandler.getHealth(switchNr) != HasHealthIF::HEALTHY) {
if (heaterHandler.getHealth(redSwitchNr) == HasHealthIF::HEALTHY) {
switchNr = redSwitchNr;
redSwitchNrInUse = true;
} else {
heaterAvailable = false;
// TODO: triggerEvent ?
}
}
}