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:
Laurent Eschenauer
2013-07-19 09:15:50 +02:00
commit 8d79ad7bd0
+4 -1
Ver Arquivo
@@ -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);
};