MEKF Fixes #843
@ -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;
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user