diff --git a/mission/controller/acs/AttitudeEstimation.cpp b/mission/controller/acs/AttitudeEstimation.cpp index e287b22f..5e07642f 100644 --- a/mission/controller/acs/AttitudeEstimation.cpp +++ b/mission/controller/acs/AttitudeEstimation.cpp @@ -24,10 +24,10 @@ void AttitudeEstimation::quest(acsctrl::SusDataProcessed *susData, // Normalize Data double normMgmB[3] = {0, 0, 0}, normMgmI[3] = {0, 0, 0}, normSusB[3] = {0, 0, 0}, normSusI[3] = {0, 0, 0}; - VectorOperations::normalize(susData->susVecTot.value, normMgmB, 3); - VectorOperations::normalize(susData->sunIjkModel.value, normMgmI, 3); - VectorOperations::normalize(mgmData->mgmVecTot.value, normSusB, 3); - VectorOperations::normalize(mgmData->magIgrfModel.value, normSusI, 3); + VectorOperations::normalize(susData->susVecTot.value, normSusB, 3); + VectorOperations::normalize(susData->sunIjkModel.value, normSusI, 3); + VectorOperations::normalize(mgmData->mgmVecTot.value, normMgmB, 3); + VectorOperations::normalize(mgmData->magIgrfModel.value, normMgmI, 3); // Create Helper Vectors double normHelperB[3] = {0, 0, 0}, normHelperI[3] = {0, 0, 0}, helperCross[3] = {0, 0, 0},