学术界最实用的STM32和ROS机器人的串口通信方案,一般人不告诉他

现在学术界最实用的STM32和ROS机器人的串口通信方案,一般人我不告诉他

全网最实用的STM32和ROS机器人的串口通信方案(大量网友调用成功)

具体协议大致如下,易读、易调用、易拓展、易更改。

20669bee2cbbdb4393f97bf77bf58b9b.png

源码文件:进入下面公众号:小白学移动机器人,发送:串口通信升级。即可获得。

本方案解决的问题:解决以STM32做ROS机器人底层驱动的串口通信问题。

为什么要写篇文章?:

最近发现越来越多的小伙伴走入ROS机器人的领域,而ROS机器人与底层驱动的串口通信问题,是大家学习路上的一个难题。很多小伙伴对STM32单片机并不熟悉,对串口通信的理解并不透彻,自己去解决这个问题,费时费力,最后也可能没有好的结果,并且这又不是大多数学习ROS机器人的重点。最后发现网上也没有很好的教程(也可能是我没找到),所以,这里根据本人的开发经历,给大家提供一种高效、稳定、易用的ROS机器人与STM32串口通信的常用方案。

如果不想了解细节的朋友,可以只看下面方案介绍和方案快速使用部分,关于方案的原理就不用花时间思考了,但是还是希望大家对细节有敬畏之心。

本方案提供的API:(最基础的ROS机器人需要的协议)

STM32向ROS发送左轮实时轮速、右轮实时轮速、实时角度、预留控制位。

ROS向STM32发送左轮设定速度、右轮设定速度、预留控制位

本方案优势:

经测试,长期稳定运行

保证数据准确率极高

频率50HZ左右,可更高,根据自己发送频率设置

易用,引入相关头文件即可,低耦合

------------------------------------------------华丽丽的分界线--------------------------------------------

方案介绍:

本方案将数据开头加入数据头,数据尾部加入数据循环冗余校验和数据尾,将数据打包发送,确保数据的正确性,避免出现一些无法察觉的问题。同样根据STM32和Linux系统配备相应的数据解析协议。

本方案STM32下位机依托USART1编写的收发协议,ROS上位机依托boost::asio编写的收发协议。串口并不一定是串口1,可以更改,但是需要程序变更一些内容(很容易,程序中有标记共三处)。

本方案巧妙的使用共用体的特性,进行数据解析,(也就是无需使用数据分离技术解析数据)。关于共用体,你只需要知道以下几点:

.C语言的一种机制,结构体内不同成员共享内存的机制,(即内存地址一致)

.同一时刻,只能访问其中的一个成员

.不同成员,按照成员类型的性质进行内存访问

不理解的小伙伴,可以看下图,有直观的理解即可。有图有真相

温馨提示:从左向右读图。

2b62092b72c149f0fb7adaac99e763c5.png

-----------------------------------------------华丽丽的分界线--------------------------------------------

方案快速使用:

硬件环境准备:(必须)

STM32串口+TTL转USB模块(CH340)+Linux硬件设备

线路连接:(有图有真相)

4b90dbcc96fa38b7c01fa95a20d726a6.png

STM32下位机软件使用介绍:

首先是STM32串口参数的配置:(这里配置代码和相关例程都一致)

·波特率=115200

·数据长度=8位

·停止位=1个

·奇偶校验位=无

·硬件数据流控制=无

其次是函数使用说明,封装函数如下图:

edad47227facad29dcc82f4fb26c92fe.png

这里做简单说明:

函数usartReceiveOneData(int *p_leftSpeedSet,int *p_rightSpeedSet,unsigned char *p_crtlFlag),填入地址参数作数据获取,使用时放在相应串口的中断服务函数中即可。如这里使用的串口1,如下图所示:

97a3b33d0f8ba6377b95dcf3a058590f.png

函数usartSendData(short leftVel, short rightVel,short angle,unsigned char ctrlFlag),填入需要发送的数据变量作发送,使用时放入指定频率的循环里使用,每次发送一次数据,最好延时10-15ms,下位机发送和上位机接收都需要时间(时间和串口波特率有关)。我使用的如下图所示:

6046fe7b73126170670d554e67e6fb24.png

其余的两个函数是被上面两个函数调用的,这里就不多说了。

注意:

在外部引用函数时,注意引用头文件#include "mbotLinuxUsart.h"

小伙伴在编译时,可能出现#include "mbotLinuxUsart.h"文件下 sys.h不存在,原因是使用的不是正点原子的例程,此时将#include 替换为各自版本的配置头文件,如果不清楚,就在其他.h文件中复制粘贴已有的头文件,关于stm32的

ROS上位机软件使用介绍:(PC)

看图说话,下面共有四个函数,看函数名和参数就可以理解用途。

a16986d337576bb33ff698e88062ce22.png

首先是调用头文件#include "mbot_linux_serial.h",然后进行初始化串口

在程序初始化的时候调用serialInit()函数,内置串口参数和下位机串口参数一致。

然后就是在调用writeSpeed(double RobotV, double YawRate,unsigned char ctrlFlag)函数,参数是机器人线速度和角速度,也就是/cmd_vel的数据。将机器人的需要设定的速度下发到下位机。

最后就是调用readSpeed(double &vx,double &vth,double &th,unsigned char &ctrlFlag)函数,这里使用的引用,输入存放机器人线速度、角速度、角度的变量即可。为了发布机器人里程计用的。

注意:

这里需要两个参数根据自己的机器人进行更改,ROBOT_LENGTH机器人真实轮间距(从左侧轮子中心到右侧轮子中心的距离),ROBOT_RADIUS机器人轮间距的一半。

文中boost::asio::serial_port sp(iosev, "/dev/mbot");的设备名字是我的串口的设备名字,小伙伴可以根据自己的进行更改,例如,/dev/ttyUSB0。

到这里大家肯定都可以愉悦的使用了。如果想知道细节,请往下看。

-------------------------------------------华丽丽的分界线-----------------------------------------------

方案的原理解释:

此方案用的是共用体的思路,上面小伙伴们也都对共用有个大致的了解。这是一种按照共用体内成员的数据类型进行内存访问的特性,不同数据类型按照自己的类型访问内存。上位机和下位机的原理是一致的。都定义了数据头、数据尾的常量,和收发共用体。

下位机发送的数据协议:上位机发送的数据协议:

3c8c2e0ac7ed2d6d5445ec277ed07326.png

STM32的串口接收原理:每接收到一个字节就会触发一次中断,我这里采用在串口的中断服务函数中进行数据接收的解析,具体函数体现在receiveTo103()

根据上位机发送的协议进行判断解析,详见代码,注释清晰。

Linux上位机采用ASIO,ASIO不仅支持网络通信,还能支持串口通信。

这里采用boost::asio::write(sp, boost::asio::buffer(buf));发送数据

使用boost::asio::read_until(sp, response, "\r\n",err);

copy(istream_iterator(istream(&response)>>noskipws),

istream_iterator(),buf);

获取数据,再具体的细节需要见源码解释了。脑子里的思想就是把相应的数据放到相应的位置,没有数据解析概念,对应的字符数据存好后,就可以通过另外一个成员访问了。

我自己在今年年初录制了一套还比较系统的入门单片机教程,想要的同学找我拿就行了免費的,私信我就可以哦~点我头像黑色字体加蚣重呺也能领取哦。

猜你喜欢

转载自blog.csdn.net/danpianji777/article/details/124085661