turtlebot3 输出打印小车速度

在小车运动过程中,将小车速度打印出来可以更好的观察和调试小车的功能。

本人是遇到turtlebot3运动过程中出现速度急停的想,所以将小车的速度打印出来,观察实时的速度变化。

下面是代码(cpp代码):

#include<ros/ros.h>
#include<tf/transform_broadcaster.h>
#include<nav_msgs/Odometry.h>
#include<geometry_msgs/Twist.h>
#include<iostream>
 
void callback(const geometry_msgs::Twist& cmd_vel)
{
    ROS_INFO("Received a /cmd_vel message!");
    ROS_INFO("Linear Components:[%f,%f,%f]",cmd_vel.linear.x,cmd_vel.linear.y,cmd_vel.linear.z);
    ROS_INFO("Angular Components:[%f,%f,%f]",cmd_vel.angular.x,cmd_vel.angular.y,cmd_vel.angular.z);
}
 
int main(int argc, char** argv)
{
    ros::init(argc, argv, "cmd_vel_listener");
    ros::NodeHandle n;
    ros::Subscriber sub = n.subscribe("cmd_vel", 1000, callback); //我的turtlebot3上面速度话题是cmd_vel,若读者不同,自己改动

//查看节点可以在终端运行:$rqt_graph     会画出当前你的小车运行的所有节点命名
    ros::spin();

    return 1;
}

猜你喜欢

转载自blog.csdn.net/congcong7267/article/details/81624298