STM32通过rosserial接入ROS通讯开发

作者:良知犹存

转载授权以及围观:欢迎添加微信公众号:羽林君

前言

主题:串口是一种设备间常用的通讯接口,rosserial将串口字符数据转发到标准ROS网络,并输出到rosout和其日志文件。本文将记录如何在ROS上使用其提供的serial包进行串口通信。

我的环境介绍:PC:使用的是Ubuntu 16-04 ROS-Kinetic嵌入式端:STM32F071

ROS机器人操作系统是用于创建机器人系统的功能强大的平台,其中包括开发项目所需的一切,从最简单的软件组件(称为“节点”)和数据交换协议到真正的凉亭机器人平台的仿真环境。至于ROS这个操作系统的介绍大家可以看我之前的那篇文章《嵌入式为什么要学ROS

总之ROS是一个在机器人设备端比较常用的分布式处理框架,但是因为ROS的包很多功能也比较复杂,所以一般都是跑在linux系统的板卡上,像stm32一类的单片机就使用的比较少,但是如果我们想用ROS的通讯接口到我们STM32中,那我们应该怎么做呢?

使用介绍

这个时候就要提起rosserial,这个ROS提供一种嵌入式节点和运行在主控PC上的ros master通信的方式,使得在嵌入式节点上编写、运行ros节点成为可能,主要用于转接IO和各类传感器,运行底层控制算法。要使用rosserial,显然需要分别在嵌入式板卡和主控PC上部署,当前支持的板卡有:arduino stm32等这些比较热门的嵌入式端。

但是目前关于结合STM32微控制器使用ROS机器人操作系统的信息,其实网上使用的还是很少,不过网上还是有几个比较好的的stm32结合ROS使用的代码,其中有一个stm32rc和rtt的配置,不过RTT的配置我使用之后发现有些问题,已经给RTT在github的仓库提交了问题

不过RT_Thread官网的文档中心还是做的很好的,对于使用ROSSERIAL的包在STM32还是介绍的很详细,大家有兴趣可以去看一下

https://www.rt-thread.org/document/site/tutorial/smart-car/ros-connect/ros-connect/

ROSLib实战的使用

首先stm32 ROS serial的使用分为两部分,分别为PC端ROS环境接收数据, 嵌入式端STM32进行发送ROS数据。

首先我是使用的其他人分享一个包进行开发的,使用的是makefile文件进行编译,编译器选择的是

gcc-arm-none-eabi-4_9-2015q3程序文件如下所示:

其中Bsp包里面主要是stm32串口串口配置的文件和时间定时的程序文件:

在这里插入图片描述

这里的配置方法其实就和我们平时的用库函数配置STM32串口的方法没什么区别,只不过是配置程序放到了HardwareSerial这个类成员函数中。

Dirver包中是我进行自定义的各种电机控制和IMU等的程序包

从程序文件的名称大家应该就可以看出来,这个部分的文件也是做外设等的基本配置,数据的基本发送和接收部分。例如:这里面wheel的配置

lib目录下有两个lib库:

其中rsolib其实就是使用ROS的时候程序中需要的头文件,ros msg的各种类。

这些类是我们定义ROS的topic或者service节点时候发送的数据类型,以及ROS serial的串口配置等头文件都在这个包里面

stm32lib是stm32配置时候的各种库文件,包括stm32f0xx.h、CMSIS、库文件和启动汇编文件

再下面src目录里面就放着我们的main.cpp

这个部分是比较重要的,main函数的部分除了初始化,我们也可以定义我们需要的topic节点。

initialise();

ros::NodeHandle nh;

nh.initNode()

while(!nh.connected()) {

// nh.loginfo("ros is not connect\r\n");

nh.spinOnce();

}

sensor_msgs::ChannelFloat32 VelFeedBack;

ros::Publisher velfeedbackpub("VelFb_", &VelFeedBack);

nh.advertise(velfeedbackpub);

nh.spinOnce();

floatfbVel[7];

while(1)

{

if((millis() - previous_debug_time) >= (1000 / DEBUG_RATE)) //定时发送

{

VelFeedBack.name ="r";

VelFeedBack.values = fbVel;

VelFeedBack.values_length = 7;

velfeedbackpub.publish(&VelFeedBack);

}

nh.spinOnce();

}

最后面是部分是makfile文件,其中makefile文件分了两部分,一个include头文件,一个makefile文件。

makefile.include文件中,和正常的IDE选项一样,里面包含了芯片选择、编译选择、链接选择、以及相应的程序文件目录设置。

其中芯片我选择了STM32F072

编译选项我按照默认,也没有修改,其中交叉编译器是用的 arm-none-eabi-gxx

makefile文件中我设置了我自行定义的程序文件

此外我还下载了arm-none-eabi-gxx的包

编译前先用export 配置一个编译器的选项:其中我下载好的编译器目录在/home/lyn/M0/gcc-arm-none-eabi-4_9-2015q3

exportPATH=/usr/local/sbin:/usr/local/bin:/usr/sbin:/usr/bin:/sbin:/bin:/usr/games:/home/lyn/M0/gcc-arm-none-eabi-4_9-2015q3/bin

使用 make 命令 编译,最后会在当前目录生成一个main.bin文件,这个时候我们就可以把main.bin文件通过j-link或者st-link下载软件把程序下载到板子中去。

PC端连接

PC端安装ROS大家可以参考我之前的ROS安装的文章,一般安装ROS都是安装的全功能版本(全功能含有ROSSERIAL),如果你只是安装了部分的话,那你还需要多进行安装ROS serial

sudo apt-get install  ros-kinetic-rosserial-python

我是使用我们最常见的USB转串口工具连接到我的电脑端口。

在这里插入图片描述

我们首先检查串口号  用命令 “ls  /dev/ttyUSB*”  一定要在程序中USB的参数完全一致。

首先在一个终端开启roscore

然后使用我们安装好的  rosserial_python 进行启动节点

rosrun rosserial_python serial_node.py /dev/ttyUSB0 _baud=115200

当然第一次启动会进行报错,权限不够,拒绝访问,,此时我们就需要对USB的权限进行设置,使得  /dev/ttyUSB0 可以被读写

sudo chmod 777 /dev/ttyUSB0

在启动过程中,我们就可以看到我们设置的publis的 VelFb_就初始化了。

此时我们使用 rostopic list 就可以看到相应注册好的通信点,然后再使用

rostopic echo /VelFb_

结语

这就是我使用STM32接入ROS节点的方法,大家有什么更好的建议可以一起和我交流,如果大家对代码感兴趣,可以在公众号后台回复我 STM32使用ROSLIB或者微信私我。我把我使用的代码和编译器一个分享给感兴趣的朋友们。

©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 203,362评论 5 477
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 85,330评论 2 381
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 150,247评论 0 337
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,560评论 1 273
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,580评论 5 365
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,569评论 1 281
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 37,929评论 3 395
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,587评论 0 258
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 40,840评论 1 297
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,596评论 2 321
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,678评论 1 329
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,366评论 4 318
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 38,945评论 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,929评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,165评论 1 259
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 43,271评论 2 349
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,403评论 2 342

推荐阅读更多精彩内容