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

Final Version of the ACS Controller #367

Merged
muellerr merged 78 commits from eggert/acs into develop 2023-02-08 13:50:11 +01:00
Conversation 1 Commits 78 Files Changed 27 +2963 -3880
114 changed files with 2963 additions and 3880 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Showing only changes of commit 9a056e6ad5 - Show all commits

5
mission/controller/acs/control/Detumble.cpp
View File

@@ -49,19 +49,16 @@ ReturnValue_t Detumble::bangbangLaw(const double *magRate, const bool magRateVal
} }
return returnvalue::OK; return returnvalue::OK;
} }
ReturnValue_t Detumble::bDotLawGyro(const double *satRate, const bool *satRateValid, ReturnValue_t Detumble::bDotLawGyro(const double *satRate, const bool *satRateValid,
const double *magField, const bool *magFieldValid, const double *magField, const bool *magFieldValid,
double *magMom) { double *magMom) {
if (!satRateValid || !magFieldValid) { if (!satRateValid || !magFieldValid) {
return DETUMBLE_NO_SENSORDATA; return DETUMBLE_NO_SENSORDATA;
} }
double gain = detumbleParameter->gainD; double gain = detumbleParameter->gainD;
double factor = -gain / pow(VectorOperations<double>::norm(magField,3),2); double factor = -gain / pow(VectorOperations<double>::norm(magField, 3), 2);
VectorOperations<double>::mulScalar(satRate, factor, magMom, 3); VectorOperations<double>::mulScalar(satRate, factor, magMom, 3);
return returnvalue::OK; return returnvalue::OK;
} }