Do not correct yaw in EKF
A temporary fix since it appears the yaw correction does not work as expected
Esse commit está contido em:
+4
-1
@@ -112,7 +112,10 @@ EKF.prototype.correct = function(measure, pose) {
|
||||
var c = K . multiply(err);
|
||||
state.x = state.x + c.e(1);
|
||||
state.y = state.y + c.e(2);
|
||||
state.yaw = state.yaw + c.e(3);
|
||||
|
||||
// TODO - This does not work, need more investigation.
|
||||
// In the meanwhile, we don't correct yaw based on observation.
|
||||
// state.yaw = state.yaw + c.e(3);
|
||||
|
||||
this._sigma = Matrix.I(3).subtract(K.multiply(H)).multiply(this._sigma);
|
||||
};
|
||||
|
||||
Referência em uma Nova Issue
Bloquear um usuário