12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

compilation issue

release/4.3a0
Frank Dellaert 2015-12-23 12:12:43 -08:00
parent 30946af981
commit d74e00ab2a
1 changed files with 3 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
gtsam/navigation/Scenario.h
View File

@ -57,7 +57,9 @@ class ExpmapScenario : public Scenario {
Pose3 pose(double t) const { return Pose3::Expmap(twist_ * t); }
Rot3 rotation(double t) const { return Rot3::Expmap(twist_.head<3>() * t); }
Vector3 omega_b(double t) const { return twist_.head<3>(); }
Vector3 velocity_n(double t) const { return rotation(t) * twist_.tail<3>(); }
Vector3 velocity_n(double t) const {
return rotation(t).matrix() * twist_.tail<3>();
}
Vector3 acceleration_n(double t) const { return rotation(t) * a_b_; }
private: