rtabmap: Added global_pose input topic (can be used to add GPS/global localization values for graph optimization using g2o)

This commit is contained in:
matlabbe
2017-05-23 17:47:56 -04:00
parent f81edcf790
commit b6b5a1795e
2 changed files with 50 additions and 0 deletions
+5
View File
@@ -40,6 +40,7 @@ SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
#include <std_msgs/Empty.h>
#include <std_msgs/Int32.h>
#include <nav_msgs/GetMap.h>
#include <geometry_msgs/PoseWithCovarianceStamped.h>
#include <rtabmap/core/Parameters.h>
#include <rtabmap/core/Rtabmap.h>
@@ -116,6 +117,7 @@ private:
void defaultCallback(const sensor_msgs::ImageConstPtr & imageMsg); // no odom
void userDataAsyncCallback(const rtabmap_ros::UserDataConstPtr & dataMsg);
void globalPoseAsyncCallback(const geometry_msgs::PoseWithCovarianceStampedConstPtr & globalPoseMsg);
void goalCommonCallback(int id, const std::string & label, const rtabmap::Transform & pose, const ros::Time & stamp, double * planningTime = 0);
void goalCallback(const geometry_msgs::PoseStampedConstPtr & msg);
@@ -255,6 +257,9 @@ private:
ros::Subscriber userDataAsyncSub_;
cv::Mat userData_;
ros::Subscriber globalPoseAsyncSub_;
geometry_msgs::PoseWithCovarianceStamped globalPose_;
bool stereoToDepth_;
bool odomSensorSync_;
float rate_;