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

run clang formating script
All checks were successful
EIVE/eive-obsw/pipeline/pr-eggert/acs This commit looks good
Details

Browse Source
This commit is contained in:
Robin Marquardt 2023-02-01 15:37:10 +01:00
parent 60e75612fd
commit 9a056e6ad5
1 changed files with 10 additions and 13 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

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

@ -48,20 +48,17 @@ ReturnValue_t Detumble::bangbangLaw(const double *magRate, const bool magRateVal
magMom[i] = -dipolMax * sign(magRate[i]); magMom[i] = -dipolMax * sign(magRate[i]);
} }
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;
} }