[游戏开发] Autoware pure_pursuit节点适配差速底盘

开发: C++知识库 Java知识库 JavaScript Python PHP知识库人工智能区块链大数据移动开发嵌入式开发工具数据结构与算法开发测试游戏开发网络协议系统运维
教程: HTML教程 CSS教程 JavaScript教程 Go语言教程 JQuery教程 VUE教程 VUE3教程 Bootstrap教程 SQL数据库教程 C语言教程 C++教程 Java教程 Python教程 Python3教程 C#教程
数码: 电脑笔记本显卡显示器固态硬盘硬盘耳机手机 iphone vivo oppo 小米华为单反装机图拉丁

-> 游戏开发 -> Autoware pure_pursuit节点适配差速底盘 -> 正文阅读

[游戏开发]Autoware pure_pursuit节点适配差速底盘

Autoware pure_pursuit节点输出的话题是 "/twist_raw"，需要转换为我们小车底盘控制速度的话题，我这里直接用"/cmd_vel"。主要任务是消息格式的转换，下面详细介绍。

使用 rostopic info 指令查看话题 /twist_raw的消息格式，查看结果为 geometry_msgs/TwistStamped 显然于我们常用的"/cmd_vel" 的消息格式不一样，cmd_vel的消息格式为geometry_msgs/Twist

使用 rosmsg show查看geometry_msgs/TwistStamped 消息的具体格式，显示如下：

创建一个功能包转换消息格式，具体如下：

# 创建功能包

mkdir -p catkin_ws/src
cd catkin_ws/src
catkin_creat_pkg vel_transform roscpp geometry_msg std_msgs

// 消息格式转换的源码

#include <ros/ros.h>
#include <std_msgs/Float32.h>
#include <geometry_msgs/TwistStamped.h>
#include <geometry_msgs/Twist.h>

ros::Publisher twist_pub_;
ros::Subscriber  twist_sub_;

void twistCmdCallback(const geometry_msgs::TwistStampedConstPtr& msg)
{
    geometry_msgs::Twist twist = msg->twist;
    twist_pub_.publish(twist);

    ROS_INFO("Transform Success !");
}

int main(int argc, char **argv)
{
    ros::init(argc, argv, "twist_transform");
    ros::NodeHandle nh;
    twist_pub_ = nh.advertise<geometry_msgs::Twist>("cmd_vel", 1);
    twist_sub_ = nh.subscribe<geometry_msgs::TwistStamped>("twist_raw", 1, twistCmdCallback);

    ros::spin();
    return 0;
}

在cmakelists.txt文件中配置下功能包即可

# 这里我的消息转换源码的文件名为twist_transform.cpp

add_executable(twist_transform src/twist_transform.cpp)

target_link_libraries(twist_transform
  ${catkin_LIBRARIES}
)

经测试，pure pursuit在差速底盘上的运行还算可以。