0.参考文章
ros:游戏手柄控制海龟
使用yocs_cmd_vel_mux进行机器人速度控制切换
yocs_cmd_vel_mux
1. 加入joystick
1.1安装罗技手柄
$sudo apt-get install ros-kinetic-joy
$sudo apt-get install ros-kinetic-joystick-drivers
$rosdep install joy
$rosmake joy
$ ls /dev/input
//应该能看到id里多了一个js0
测试一下:
$sudo jstest /dev/input/js0
//按下手柄收到变化
1.2用小乌龟测试一下手柄
五个终端分别打开
$roscore
$rosrun turtlesim turtlesim_node
$rosrun turtlesim turtle_teleop_key
$rosrun joy joy_node
$rosrun rqt_graph
可以看到:
我的/joy_node 发出来的东西没有被/turtlesim接收到
看一下两个node的info
$ rosnode list
$ rosnode info /joy_node
$ rosnode info /turtlesim
-
可以看出 /joy_node节点pub出来的消息是: /joy [sensor_msgs/Joy];;而/turtlesim节点sub的消息是:/turtle1/cmd_vel [geometry_msgs/Twist]*
-
所以我们要在这两个节点之间加上一个转换节点:可接受 /turtle1/cmd_vel [geometry_msgs/Twist]
并发送/turtle1/cmd_vel [geometry_msgs/Twist];网上有teleop_twist_joy可直接用 后面再使用一下 这边复现一下别人的程序
1.2.1创建joy与turtlesim之间的通信节点
$cd catkin_ws/src
$catkin_create_pkg joy_turtlesim roscpp rospy std_msgs
//在你的工作空间下创建一个叫joy_turtlesim的包
在该包下创建chanel.cpp文件;;注意空格可能影响catkin_make 可以把所有空格删除了自己添加
#include <ros/ros.h>
#include <geometry_msgs/Twist.h>
#include <sensor_msgs/Joy.h>
#include <iostream>
using namespace std;
class Teleop
{
public:
Teleop();
private:
void callback(const sensor_msgs::Joy::ConstPtr& Joy);
ros::NodeHandle n; //实例化节点
ros::Subscriber sub ;
ros::Publisher pub ;
double vlin