diff options
Diffstat (limited to 'src/feature.cpp')
| -rw-r--r-- | src/feature.cpp | 2 |
1 files changed, 1 insertions, 1 deletions
diff --git a/src/feature.cpp b/src/feature.cpp index 9c6bf84..85396e3 100644 --- a/src/feature.cpp +++ b/src/feature.cpp @@ -350,7 +350,7 @@ Feature::Fx ( double dt ) y2 = X[2]; Matrix<double,3,STATESIZE> F; F = Matrix<double,3,STATESIZE>::Zero(); - F.block<3,3>(0,3) << y0*y2,-y2, + F.block<3,3>(0,3) << y0*y2,-y2, 0., y1*y2, 0.,-y2, y2*y2, 0, 0; F *= dt; |