diff options
Diffstat (limited to 'src/state.cpp')
| -rw-r--r-- | src/state.cpp | 1 |
1 files changed, 1 insertions, 0 deletions
diff --git a/src/state.cpp b/src/state.cpp index 32801f8..055a3d1 100644 --- a/src/state.cpp +++ b/src/state.cpp @@ -105,6 +105,7 @@ State::H ( const Quaterniond &q, const vector<measurement_t> &z ) h.block<4,STATESIZE>(row,0) = fi->Hx(pos,q).block<4,STATESIZE>(2,0); h.block<4,3>(row,col) = fi->Hy(pos,q).block<4,3>(2,0); row += 4; + break; case HEIGHT: h.block<1,STATESIZE>(row,0) = body->H(); |