diff --git a/gtsam/slam/pose2SLAM.h b/gtsam/slam/pose2SLAM.h index 42e22a85d..50944cf2f 100644 --- a/gtsam/slam/pose2SLAM.h +++ b/gtsam/slam/pose2SLAM.h @@ -23,6 +23,7 @@ #include #include #include +#include #include // Use pose2SLAM namespace for specific SLAM instance @@ -100,6 +101,12 @@ namespace pose2SLAM { /// Optimize Values optimize(const Values& initialEstimate) const; + + /// Return a Marginals object + Marginals marginals(const Values& solution) const { + return Marginals(*this,solution); + } + }; } // pose2SLAM