odom->base_link

最新推荐文章于 2025-02-24 21:29:23 发布

zgrobot

最新推荐文章于 2025-02-24 21:29:23 发布

阅读量692

点赞数 1

CC 4.0 BY-SA版权

分类专栏： ros使用文章标签： ros 机器人

本文链接：https://blog.youkuaiyun.com/zgneu/article/details/53119089

ros使用专栏收录该内容

19 篇文章

订阅专栏

本文介绍如何使用ROS (Robot Operating System) 实现机器人的位置跟踪与速度更新。通过tf::TransformBroadcaster发布坐标变换，并利用nav_msgs::Odometry发布机器人的位置与速度信息。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

tf::TransformBroadcaster odom_broadcaster;

ros::Time current_time,last_time;

current_time = ros::Time::now();
geometry_msgs::Quaternion odom_quat = tf::createQuaternionMsgFromYaw(t);
geometry_msgs::TransformStamped odom_trans;
odom_trans.header.stamp = current_time;
odom_trans.header.frame_id = "odom";
odom_trans.child_frame_id = "base_link";

odom_trans.transform.translation.x = x;
odom_trans.transform.translation.y = y;
odom_trans.transform.translation.z = 0;
odom_trans.transform.rotation = odom_quat;
odom_broadcaster.sendTransform(odom_trans);

nav_msgs::Odometry odom;
odom.header.stamp = current_time;
odom.header.frame_id = "odom";
odom.pose.pose.position.x = x;
odom.pose.pose.position.y = y;
odom.pose.pose.position.z = 0.0;
odom.pose.pose.orientation = odom_quat;
odom.child_frame_id = "base_link";
odom.twist.twist.linear.x = vx;
odom.twist.twist.linear.y = vy;
odom.twist.twist.angular.z = vth;
odom_pub.publish(odom);