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

ACS Subsystem Init #228

Merged
muellerr merged 83 commits from mueller/acs-ss-init into develop 2022-11-02 10:34:40 +01:00
Conversation 1 Commits 83 Files Changed 56 +244 -181
1 changed files with 244 additions and 181 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files
Showing only changes of commit bb0ce1a329 - Show all commits

67
mission/controller/ThermalController.cpp
View File

@ -234,6 +234,7 @@ ReturnValue_t ThermalController::checkModeCommand(Mode_t mode, Submode_t submode
}
void ThermalController::copySensors() {
{
PoolReadGuard pg0(&max31865Set0);
if (pg0.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_ploc_heatspreader.value = max31865Set0.temperatureCelcius.value;
@ -242,7 +243,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_ploc_heatspreader.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg1(&max31865Set1);
if (pg1.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_ploc_missionboard.value = max31865Set1.temperatureCelcius.value;
@ -251,7 +254,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_ploc_missionboard.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg2(&max31865Set2);
if (pg2.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_4k_camera.value = max31865Set2.temperatureCelcius.value;
@ -260,7 +265,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_4k_camera.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg3(&max31865Set3);
if (pg3.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_dac_heatspreader.value = max31865Set3.temperatureCelcius.value;
@ -269,7 +276,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_dac_heatspreader.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg4(&max31865Set4);
if (pg4.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_startracker.value = max31865Set4.temperatureCelcius.value;
@ -278,7 +287,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_startracker.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg5(&max31865Set5);
if (pg5.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_rw1.value = max31865Set5.temperatureCelcius.value;
@ -287,7 +298,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_rw1.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg6(&max31865Set6);
if (pg6.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_dro.value = max31865Set6.temperatureCelcius.value;
@ -296,7 +309,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_dro.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg7(&max31865Set7);
if (pg7.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_scex.value = max31865Set7.temperatureCelcius.value;
@ -305,7 +320,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_scex.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg8(&max31865Set8);
if (pg8.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_x8.value = max31865Set8.temperatureCelcius.value;
@ -314,7 +331,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_x8.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg9(&max31865Set9);
if (pg9.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_hpa.value = max31865Set9.temperatureCelcius.value;
@ -323,7 +342,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_hpa.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg10(&max31865Set10);
if (pg10.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_tx_modul.value = max31865Set10.temperatureCelcius.value;
@ -332,7 +353,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_tx_modul.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg11(&max31865Set11);
if (pg11.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_mpa.value = max31865Set11.temperatureCelcius.value;
@ -341,7 +364,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_mpa.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg12(&max31865Set12);
if (pg12.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_acu.value = max31865Set12.temperatureCelcius.value;
@ -350,7 +375,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_acu.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg13(&max31865Set13);
if (pg13.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_plpcdu_heatspreader.value = max31865Set13.temperatureCelcius.value;
@ -360,7 +387,10 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_plpcdu_heatspreader.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg14(&max31865Set14);
if (pg14.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_tcs_board.value = max31865Set14.temperatureCelcius.value;
@ -369,7 +399,9 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_tcs_board.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg15(&max31865Set15);
if (pg15.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_magnettorquer.value = max31865Set15.temperatureCelcius.value;
@ -378,16 +410,22 @@ void ThermalController::copySensors() {
sensorTemperatures.sensor_magnettorquer.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg111(&tmp1075Set1);
if (pg1.getReadResult() == returnvalue::OK) {
if (pg111.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_tmp1075_1.value = tmp1075Set1.temperatureCelcius.value;
sensorTemperatures.sensor_tmp1075_1.setValid(tmp1075Set1.temperatureCelcius.isValid());
if (not tmp1075Set1.temperatureCelcius.isValid()) {
sensorTemperatures.sensor_tmp1075_1.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg112(&tmp1075Set2);
if (pg2.getReadResult() == returnvalue::OK) {
if (pg112.getReadResult() == returnvalue::OK) {
sensorTemperatures.sensor_tmp1075_2.value = tmp1075Set2.temperatureCelcius.value;
sensorTemperatures.sensor_tmp1075_2.setValid(tmp1075Set2.temperatureCelcius.isValid());
if (not tmp1075Set2.temperatureCelcius.isValid()) {
@ -395,8 +433,10 @@ void ThermalController::copySensors() {
}
}
}
}
void ThermalController::copySus() {
{
PoolReadGuard pg0(&susSet0);
if (pg0.getReadResult() == returnvalue::OK) {
susTemperatures.sus_0_n_loc_xfyfzm_pt_xf.value = susSet0.temperatureCelcius.value;
@ -405,7 +445,9 @@ void ThermalController::copySus() {
susTemperatures.sus_0_n_loc_xfyfzm_pt_xf.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg1(&susSet1);
if (pg1.getReadResult() == returnvalue::OK) {
susTemperatures.sus_6_r_loc_xfybzm_pt_xf.value = susSet1.temperatureCelcius.value;
@ -414,7 +456,9 @@ void ThermalController::copySus() {
susTemperatures.sus_6_r_loc_xfybzm_pt_xf.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg2(&susSet2);
if (pg2.getReadResult() == returnvalue::OK) {
susTemperatures.sus_1_n_loc_xbyfzm_pt_xb.value = susSet2.temperatureCelcius.value;
@ -423,7 +467,9 @@ void ThermalController::copySus() {
susTemperatures.sus_1_n_loc_xbyfzm_pt_xb.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg3(&susSet3);
if (pg3.getReadResult() == returnvalue::OK) {
susTemperatures.sus_7_r_loc_xbybzm_pt_xb.value = susSet3.temperatureCelcius.value;
@ -432,7 +478,9 @@ void ThermalController::copySus() {
susTemperatures.sus_7_r_loc_xbybzm_pt_xb.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg4(&susSet4);
if (pg4.getReadResult() == returnvalue::OK) {
susTemperatures.sus_2_n_loc_xfybzb_pt_yb.value = susSet4.temperatureCelcius.value;
@ -441,7 +489,9 @@ void ThermalController::copySus() {
susTemperatures.sus_2_n_loc_xfybzb_pt_yb.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg5(&susSet5);
if (pg5.getReadResult() == returnvalue::OK) {
susTemperatures.sus_8_r_loc_xbybzb_pt_yb.value = susSet5.temperatureCelcius.value;
@ -450,7 +500,9 @@ void ThermalController::copySus() {
susTemperatures.sus_8_r_loc_xbybzb_pt_yb.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg6(&susSet6);
if (pg6.getReadResult() == returnvalue::OK) {
susTemperatures.sus_3_n_loc_xfybzf_pt_yf.value = susSet6.temperatureCelcius.value;
@ -459,7 +511,9 @@ void ThermalController::copySus() {
susTemperatures.sus_3_n_loc_xfybzf_pt_yf.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg7(&susSet7);
if (pg7.getReadResult() == returnvalue::OK) {
susTemperatures.sus_9_r_loc_xbybzb_pt_yf.value = susSet7.temperatureCelcius.value;
@ -468,7 +522,9 @@ void ThermalController::copySus() {
susTemperatures.sus_9_r_loc_xbybzb_pt_yf.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg8(&susSet8);
if (pg8.getReadResult() == returnvalue::OK) {
susTemperatures.sus_4_n_loc_xmyfzf_pt_zf.value = susSet8.temperatureCelcius.value;
@ -477,7 +533,9 @@ void ThermalController::copySus() {
susTemperatures.sus_4_n_loc_xmyfzf_pt_zf.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg9(&susSet9);
if (pg9.getReadResult() == returnvalue::OK) {
susTemperatures.sus_10_n_loc_xmybzf_pt_zf.value = susSet9.temperatureCelcius.value;
@ -486,7 +544,9 @@ void ThermalController::copySus() {
susTemperatures.sus_10_n_loc_xmybzf_pt_zf.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg10(&susSet10);
if (pg10.getReadResult() == returnvalue::OK) {
susTemperatures.sus_5_n_loc_xfymzb_pt_zb.value = susSet10.temperatureCelcius.value;
@ -495,7 +555,9 @@ void ThermalController::copySus() {
susTemperatures.sus_5_n_loc_xfymzb_pt_zb.value = INVALID_TEMPERATURE;
}
}
}
{
PoolReadGuard pg11(&susSet11);
if (pg11.getReadResult() == returnvalue::OK) {
susTemperatures.sus_11_r_loc_xbymzb_pt_zb.value = susSet11.temperatureCelcius.value;
@ -505,6 +567,7 @@ void ThermalController::copySus() {
}
}
}
}
void ThermalController::copyDevices() {
lp_var_t<float> tempQ7s = lp_var_t<float>(objects::CORE_CONTROLLER, core::PoolIds::TEMPERATURE);