MEKF Fixes #843

Merged
meggert merged 13 commits from mekf-fix into main 2024-02-29 13:08:25 +01:00
Showing only changes of commit 5876ad1f56 - Show all commits

View File

@ -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;
}