1.通信协议
控制指令格式(15字节)
2.ROS端
在ROS端,首先需要接收从其他节点的控制消息,在ROS中常常使用geometry_msgs::Twist来传递控制指令,该消息格式包括两个三维向量,如下,分别是三轴线速度和三轴角速度:
geometry_msgs/Vector3 linear
geometry_msgs/Vector3 angular
我们在控制指令的消息回调函数中,将控制指令下发给STM32,部分程序如下,其中使用了C++的lambda表达式来替换回调函数
ros::Subscriber sub = nh.subscribe< geometry_msgs::Twist >("/cmd_vel", 10, [&](const geometry_msgs::Twist::ConstPtr& cmd_vel){
uint8_t _cnt = 0;
data_u _temp; // 声明一个联合体实例,使用它将待发送数据转换为字节数组
uint8_t data_to_send[100]; // 待发送的字节数组
data_to_send[_cnt++]=0xAA;
data_to_send[_cnt++]=0x55;
uint8_t _start = _cnt;
float datas[] = {(float)cmd_vel- >linear.x,
(float)cmd_vel- >linear.y,
(float)cmd_vel- >angular.z};
for(int i = 0; i < sizeof(datas) / sizeof(float); i++){
// 将要发送的数据赋值给联合体的float成员
// 相应的就能更改字节数组成员的值
_temp.data = datas[i];
data_to_send[_cnt++]=_temp.data8[0];
data_to_send[_cnt++]=_temp.data8[1];
data_to_send[_cnt++]=_temp.data8[2];
data_to_send[_cnt++]=_temp.data8[3]; // 最高位
}
// 添加校验码
char checkout = 0;
for(int i = _start; i < _cnt; i++)
checkout += data_to_send[i];
data_to_send[_cnt++] = checkout;
// 串口发送
ser.write(data_to_send, _cnt);
});
最后,创建一个控制指令发布节点,用来发布cmd_vel话题,在xrobot功能包下新建一个scripts文件夹,添加remote_ctrl.py,内容如下:
#!/usr/bin/env python
# #-*- coding: UTF-8 -*-
import rospy
from geometry_msgs.msg import Twist
from std_msgs.msg import String
import os, sys
import tty, termios
pub = rospy.Publisher("cmd_vel", Twist)
rospy.init_node("remote_ctrl")
rate = rospy.Rate(rospy.get_param("-hz", 20))
cmd = Twist()
cmd.linear.x = 0.0
cmd.linear.y = 0.0
cmd.angular.z = 0.0
while not rospy.is_shutdown():
tty.setraw(sys.stdin.fileno())
ch = sys.stdin.read( 1 )
if ch == "w":
cmd.linear.x = 0.2
cmd.linear.y = 0
cmd.angular.z = 0
elif ch == "s":
cmd.linear.x = -0.2
cmd.linear.y = 0
cmd.angular.z = 0
elif ch == "a":
cmd.linear.x = 0
cmd.linear.y = 0
cmd.angular.z = 0.5
elif ch == "d":
cmd.linear.x = 0
cmd.linear.y = 0
cmd.angular.z = -0.5
elif ch == "q":
break
else:
cmd.linear.x = 0
cmd.linear.y = 0
cmd.angular.z = 0
rospy.loginfo(str( cmd.linear.x) + " " + str(cmd.linear.y) + " " + str(cmd.angular.z) + "rn")
pub.publish(cmd)
rate.sleep()
运行robot_node和remote_ctrl节点,可以得到如下的节点图:
声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。
举报投诉
-
机器人
+关注
关注
206文章
27043浏览量
201423 -
控制指令
+关注
关注
0文章
12浏览量
5337 -
ROS
+关注
关注
1文章
271浏览量
16682 -
自主导航
+关注
关注
0文章
12浏览量
5233
发布评论请先 登录
相关推荐
【Aworks申请】家庭服务机器人
家庭环境是动态变化的,如家具等可能移动位置,因此需要完成自定位的同时完成环境地图创建,并在此基础上实现从当前位置到目标位置的自主导航。4 人机交互与语音识别技术机器人需要与人类进行交流,人可以通过语音向
发表于 07-19 23:33
【HiKey申请】自主导航机器人
对机器人进行控制和数据传输。搭载摄像头可以实现远程监控和遥控,搭载机械臂可以实现抓取物体。详细计划:在HIKEY上跑ROS,使用rplidar(或者kinect),先进行地图建模,然后在根据建立的地图
发表于 04-05 12:17
激光导航AGV底盘定制 巡检机器人,服务机器人,智慧物流搬运AGV
技术先进的无反射板激光导航移动平台。同时为这些相关行业提供智慧物流以及仓储系统解决方案。 苏州智伟达机器人科技有限公司根据LNM自主导航解决方案自主研发激光
发表于 06-10 14:24
SLAM不等于机器人自主定位导航
和即时定位问题,而自主导航需要解决的是智能移动机器人与环境进行自主交互,尤其是点到点自主移动的问题,这需要更多的技术支持。 要想解决机器人智
发表于 08-24 16:56
基于机器视觉的智能导览机器人控制系统设计
参访者进行简单对话等功能,并具有对外界环境快速反应和自适应能力。基于层次结构,导览机器人可分为:人工智能层、控制协调层和运动执行层。其中人工智能层主要利用CCD摄像头规划和自主导航机器人
发表于 07-04 08:30
【Toybrick RK3399Pro AI开发板试用体验】机器人自主导航
到达指定位置、机器人定时巡逻、跟随等等,于是有了机器人实时定位与导航。定位定位算法使用自适应的蒙特卡洛(AMCL),蒙特卡洛是一种经典的粒子滤波算法,它适应于局部定位和全局定位两类问题,自适应解决了
发表于 08-21 22:12
暗物智能广州公司招聘机器人岗位贴(导航&&应用开发)
一.机器人导航算法工程师岗位职责:1. 负责机器人视觉或激光雷达的SLAM算法的研发和优化;2. 负责机器人自主导航定位算法的研发,主要包括
发表于 06-08 05:06
【科普】干货!带你从0了解移动机器人(三) ——自主导航系统及上位机软件设计与实现
量,保证移动机器人按照规划路径顺利地到达目标位置。而开环控制则是根据预先设定的控制量进行运动控制,不考虑机器人当前状态的影响。开环
发表于 06-28 09:36
评论