diff --git a/mission/controller/acs/MultiplicativeKalmanFilter.cpp b/mission/controller/acs/MultiplicativeKalmanFilter.cpp index 06595ec3..c6431aa2 100644 --- a/mission/controller/acs/MultiplicativeKalmanFilter.cpp +++ b/mission/controller/acs/MultiplicativeKalmanFilter.cpp @@ -629,8 +629,8 @@ void MultiplicativeKalmanFilter::updateDataSet( void MultiplicativeKalmanFilter::setStrData(double qX, double qY, double qZ, double qW, bool valid) { strData.strQuat.value[0] = qX; - strData.strQuat.value[1] = qX; - strData.strQuat.value[2] = qX; - strData.strQuat.value[3] = qX; + strData.strQuat.value[1] = qY; + strData.strQuat.value[2] = qZ; + strData.strQuat.value[3] = qW; strData.strQuat.valid = valid; }