MEKF Fixes #843
@ -629,8 +629,8 @@ void MultiplicativeKalmanFilter::updateDataSet(
|
|||||||
void MultiplicativeKalmanFilter::setStrData(double qX, double qY, double qZ, double qW,
|
void MultiplicativeKalmanFilter::setStrData(double qX, double qY, double qZ, double qW,
|
||||||
bool valid) {
|
bool valid) {
|
||||||
strData.strQuat.value[0] = qX;
|
strData.strQuat.value[0] = qX;
|
||||||
strData.strQuat.value[1] = qX;
|
strData.strQuat.value[1] = qY;
|
||||||
strData.strQuat.value[2] = qX;
|
strData.strQuat.value[2] = qZ;
|
||||||
strData.strQuat.value[3] = qX;
|
strData.strQuat.value[3] = qW;
|
||||||
strData.strQuat.valid = valid;
|
strData.strQuat.valid = valid;
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user