Final Version of the ACS Controller #367
@@ -49,13 +49,11 @@ 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;
|
||||||
}
|
}
|
||||||
@@ -63,5 +61,4 @@ ReturnValue_t Detumble::bDotLawGyro(const double *satRate, const bool *satRateVa
|
|||||||
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;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
Reference in New Issue
Block a user