From 9458b30126e346c9e0d373c9df5690655bf7f8ab Mon Sep 17 00:00:00 2001 From: Martin Miller Date: Fri, 24 Mar 2017 13:30:50 -0500 Subject: Body can return velocity --- src/body.cpp | 8 +++++++- 1 file changed, 7 insertions(+), 1 deletion(-) (limited to 'src/body.cpp') diff --git a/src/body.cpp b/src/body.cpp index caa7cb9..a5c572a 100644 --- a/src/body.cpp +++ b/src/body.cpp @@ -234,6 +234,12 @@ Body::accelerometer_bias ( const Vector3d &b ) Vector3d Body::ned ( ) { - return X.segment(0,3) ; + return X.segment<3>(0); } /* ----- end of method Body::ned ----- */ +Vector3d +Body::vel ( ) +{ + return X.segment<3>(3); +} /* ----- end of method Body::vel ----- */ + -- cgit v1.1