diff options
Diffstat (limited to 'src/body.cpp')
| -rw-r--r-- | src/body.cpp | 14 |
1 files changed, 13 insertions, 1 deletions
diff --git a/src/body.cpp b/src/body.cpp index 2a907a1..caa7cb9 100644 --- a/src/body.cpp +++ b/src/body.cpp @@ -207,7 +207,6 @@ Body::skewSymmetric ( const Vector3d &x ) return y; } /* ----- end of method Body::skewSymmetric ----- */ - void Body::unicsv ( ) { @@ -225,3 +224,16 @@ Body::accelerometer_bias ( const Vector3d &b ) return ; } /* ----- end of method State::accelerometer_bias ----- */ +/* + *-------------------------------------------------------------------------------------- + * Class: Body + * Method: Body :: ned + * Description: Returns the body position in NED coordinates. + *-------------------------------------------------------------------------------------- + */ +Vector3d +Body::ned ( ) +{ + return X.segment(0,3) ; +} /* ----- end of method Body::ned ----- */ + |