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

adds Expression wrapper for Pose3::InterpolateRt

release/4.3a0
Brett Downing 2025-02-27 16:28:17 +11:00
parent 82bc6d8931
commit a5a89686c6
1 changed files with 4 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
gtsam/slam/expressions.h
View File

@ -58,6 +58,10 @@ inline Pose3_ transformPoseTo(const Pose3_& p, const Pose3_& q) {
return Pose3_(p, &Pose3::transformPoseTo, q);
}
inline Pose3_ interpolateRt(const Pose3_& p, const Pose3_& q, const Double_& t) {
return Pose3_(&Pose3::interpolateRt, p, q, t);
}
inline Point3_ normalize(const Point3_& a){
Point3 (*f)(const Point3 &, OptionalJacobian<3, 3>) = &normalize;
return Point3_(f, a);