【XR806开发板试用】+移植rosserial到XR806

1 XR806简介

板子来源于极术社区的试用,XR806的在线网址
c.png
其主要参数:

主控XR806AF2L
DDRSIP 288KB SRAM
存储SIP 160KB Code ROM. SIP 16Mbit Flash.
天线板载WiFi/BT双天线,可共存
按键reboot按键 1,功能按键 1
红色电源指示灯 1,蓝色可调节LED 1
供电Type-C 5V
引脚插针引脚 *9
调试方式Type-C(已板载串口转USB芯片)
晶振外接40MHz晶振

2 rosserial简介

官网

rosserial是用于非ROS设备与ROS设备进行通信的一种协议。它为非ROS设备的应用程序提供了ROS节点和服务的发布/订阅功能,使在非ROS环境中运行的应用能够通过串口或网络能够轻松地与ROS应用进行数据交互。

rosserial分为客户端服务器两部分。rosserial客户端运行在运行在没有安装ROS的环境的应用中,通过串口或网络与运行在ROS环境中的rosserial服务器连接,并通过服务器节点在ROS中发布/订阅话题。

3 移植目标

通过rosserial使XR806能通过串口和TCP两种方式和ROS进行通信。

4 移植前准备

4.1 源码获取

[官方源码]( https://github.com/ros-drivers/rosserial.git
该仓库中的代码需要编译才能获取源码,为了直接获取源码,使用以下仓库的源码做为基础。

使用源码

该代码时属于RT-thread软件包,有较高的可信度。
clone下来的代码放在/ohosdemo/rosserial中,文件结构:
tree -L 1

tree -L 1.
├── BUILD.gn
├── inc
├── port
└── src
  • BUILD.gn :配置文件
  • inc :rosserial源文件
  • port:移植文件(为了和XR806适配的代码放在该文件下)

4.2 XR806 C++支持

rosserial为C++代码,需要XR806支持C++编译。

  1. 修改/device/xradio/xr806/liteos_m/config.gni文件,添加以下内容:
board_cxx_flags = []board_cxx_flags += SDK_cflags
board_cxx_flags += ["-includelog/log.h","-DVIRTUAL_HCI","-DCONFIG_ARM",#"-DNULL=((void*)0)",#"-std=c++17","-lstdc++","-fno-rtti","-fno-exceptions"]

大部分和board_cflags的配置一样,添加的编译项 "-lstdc++",-fno-rtti,-fno-exception是为了解决以下错误:

 undefined reference to `vtable for __cxxabiv1::__si_class_type_info'

该错误的原因是C++在链接时会有相关库链接不上
2. 在/ohosdemo/rosserial/BUILD.gn中添加以下代码:

cflags_cc = board_cxx_flags

表示支持c++编译

5 ROSserial移植核心

根据官网的移植介绍,只需要填写完以下模板即可:

class Hardware
{Hardware();// any initialization code necessary to use the serial portvoid init(); // read a byte from the serial port. -1 = failureint read()// write data to the connection to ROSvoid write(uint8_t* data, int length);// returns milliseconds since start of programunsigned long time();};
  • init():提供初始化函数,初始化串口或者TCP网络
  • read():读取一个字节
  • write(uint8_t* data, int length):写字符
  • time():提供时间基准

6 串口通信

和串口相关的代码放在rosserial/port/UartHaedware.h
关键代码:

6.1 串口初始化:init()函数

void init(){//    HAL_Status status = HAL_ERROR;UART_InitParam param;param.baudRate = this->baudRate;param.dataBits = UART_DATA_BITS_8;param.stopBits = UART_STOP_BITS_1;param.parity = UART_PARITY_NONE;param.isAutoHwFlowCtrl = 0;HAL_UART_Init(UARTID, &param);}

6.2 串口读取一个字节:read()函数

int read(){uint8_t rx_data;int32_t len=0;len = HAL_UART_Receive_IT(UARTID,&rx_data,1,1000);if(len>0){return rx_data;}else return -1;}

6.3 串口写字节:write(uint8_t* data, int length)

// write data to the connection to ROSvoid write(uint8_t* data, int length){HAL_UART_Transmit_IT(UARTID, data, length);}

6.4 时间基准:time()函数

  // returns milliseconds since start of programunsigned long time(){unsigned long temp = (unsigned long)OS_GetTime() * 1000;return temp;}

6.5 代码风格统一

为了保持ROS代码的编写风格一致,添加``rosserial/port/ros.h`
关键代码:


#define ROS_USE_TCP 0
#define ROS_USE_UART 1namespace ros
{#if ROS_USE_TCP == 1typedef NodeHandle_<TCPHardware> NodeHandle;#endif#if ROS_USE_UART == 1typedef NodeHandle_<Hardware> NodeHandle;#endif
}
#endif

可以通过宏定义选择使用串口还是TCP

7 TCP通信

7.1 wifi连接

wifi连接使用官方在ohosdemo/wlan_demo中的代码。具体使用void wifi_device_event_test()函数和wifi连接成功后的回调函数:void Connected_deal(int state, WifiLinkedInfo *info)

大致思路是在wifi连接线程中增加一个信号量,初始化信号量为0,rosserial线程会一直等待信号量有效后才会触发rosserial的相关函数,利用信号量作为两个线程间的同步,保证wifi顺利连接成功后才会进行rosserial的TCP通信。另外每次wifi重新连接后都会保证XR806会自动连接ROS。

信号量的三个关键函数:

  • OS_Status OS_SemaphoreCreate(OS_Semaphore_t *sem, uint32_t initCount, uint32_t maxCount)初始化信号量,定义计数的初始值和最大值

  • OS_Status OS_SemaphoreWait(OS_Semaphore_t *sem, OS_Time_t waitMS) 等待信号量有效,及信号量的计数不为0;等待时间可以使无限长,该参数为OS_WAIT_FOREVER

  • OS_Status OS_SemaphoreRelease(OS_Semaphore_t *sem)释放信号量,信号量计数加1;

    主要代码:

    
    #define WIFI_DEVICE_CONNECT_AP_SSID "myyy"
    #define WIFI_DEVICE_CONNECT_AP_PSK "123456789"WifiEvent sta_event;void Connected_deal(int state, WifiLinkedInfo *info)
    {if (state == WIFI_STATE_AVALIABLE) {//释放信号量,计数加1OS_SemaphoreRelease(&ros_sem);// OS_Sleep(5);printf("\r\n======== Callback: connected========\r\n");} else if (state == WIFI_STATE_NOT_AVALIABLE) {printf("======== Callback: disconnected\n");}
    }void wifi_device_event_test()
    {const char ssid_want_connect[] = WIFI_DEVICE_CONNECT_AP_SSID;const char psk[] = WIFI_DEVICE_CONNECT_AP_PSK;//创建信号量:初始值为0,最大值为2if(OS_SemaphoreCreate(&ros_sem, 0, 2) != OS_OK){printf("\r\n sem creat fail!\r\n");return ;}sta_event.OnWifiConnectionChanged = Connected_deal;if (WIFI_SUCCESS != RegisterWifiEvent(&sta_event)) {printf("Error: RegisterWifiEvent fail\n");return;}printf("\n=========== Connect Test Start ===========\n");if (WIFI_SUCCESS != EnableWifi()) {printf("Error: EnableWifi fail.\n");return;}printf("EnableWifi Success.\n");if (WIFI_STA_ACTIVE == IsWifiActive())printf("Wifi is active.\n");OS_Sleep(1);/*.........................................................省略的代码 参见官方demo*/if (WIFI_SUCCESS != GetDeviceMacAddress(get_mac_res)) {printf("Error: GetDeviceMacAddress Fail\n");return;}printf("GetDeviceMacAddress Success.\n");for (int j = 0; j < WIFI_MAC_LEN - 1; j++) {printf("%02X:", get_mac_res[j]);}printf("%02X\n", get_mac_res[WIFI_MAC_LEN - 1]);}
    

7.2 TCP客户端初始化

为了不和串口的Hardware类重名,类名为TCPHardware

 void init(){sock_fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP);// address info!struct sockaddr_in server_addr;memset(&server_addr, 0, sizeof(server_addr));server_addr.sin_family = AF_INET;server_addr.sin_port = htons(serverPort_);inet_pton(AF_INET, server_, &server_addr.sin_addr);// connect!if (connect(sock_fd, (sockaddr *)&server_addr, sizeof(server_addr)) < 0){printf("connect tcp_server failed! \r\n");return;}printf("connect tcp_server successfuly! \r\n");}

7.3 TCP读取字节

int read(){char ch[2];int bytes_received = recv(sock_fd, ch, 1, 0);if (bytes_received > 0){return ch[0];}else{return -1;}}

7.4 TCP写字节

  void write(const uint8_t *data, int length){send(sock_fd, data, length, 0);}

时间基准和6.4一样

8 测试

8.1 XR806 端

文件目录:

.
├── BUILD.gn
├── led_demo
│   ├── BUILD.gn
│   └── src
├── rosserial
│   ├── BUILD.gn
│   ├── inc
│   ├── port
│   └── src
└── wlan_demo├── BUILD.gn├── main.c├── test_case.c└── test_case.h

其中:

  • led_demo:led灯,指示作用
  • rosserial:rosserialb包
  • wlan_demo:负载wifi连接
8.1.1 配置文件BUILD.gn
# 必须,config中定义了头文件路径和关键宏定义
import("//device/xradio/xr806/liteos_m/config.gni")# 必须,所有应用工程必须是app_打头
static_library("app_rosserial")
{configs = []sources = ["src/ros_helloworld.cpp","inc/duration.cpp","inc/time.cpp",]#必须,board_cflags是在config.gni中定义的关键宏定义cflags = board_cflags# c++cflags_cc = board_cxx_flags#必须,board_include_dirs是在config.gni中定义的文件路径include_dirs = board_include_dirs# 根据实际情况添加头文件路径include_dirs += ["//kernel/liteos_m/kernel/arch/include","./../wlan_demo/","inc","port" ,"//base/iot_hardware/peripheral/interfaces/kits","//foundation/communication/wifi_lite/interfaces/wifiservice",]
}
8.1.2 测试程序
  • 编写一个发布话题:XR806_to_ROS

发布的内容为“hello world!”,时间间隔为1s

  • 编写一个接收话题:ROS_to_XR860

接收的内容通过串口显示出来

#include <ros.h>
#include <std_msgs/String.h>#include <stdio.h>
#include "ohos_init.h"
#include <stdlib.h>//信号量的声明
extern OS_Semaphore_t ros_sem;static OS_Thread_t g_main_thread;static ros::NodeHandle  nh;
static std_msgs::String str_msg;
static ros::Publisher chatter("XR806_to_ROS", &str_msg);
static char hello_msg[25] = "hello world!";// 回调函数
static void message_callback(const std_msgs::String& msgs)
{printf("\r\nresive:%s\r\n", msgs.data);}static ros::Subscriber<std_msgs::String> sub("ROS_to_XR860", &message_callback);static void ROSThread(void *arg)
{   //等待信号量有效if (OS_SemaphoreWait(&ros_sem, OS_WAIT_FOREVER) == OS_OK){printf("\r\n--------- star ROS----------------\r\n");nh.initNode();nh.advertise(chatter);nh.subscribe(sub);while (1){if (nh.connected()){str_msg.data = hello_msg;chatter.publish(&str_msg); }nh.spinOnce();OS_MSleep(1000);} }   
}
void ROSMain(void)
{printf("\r\nROSserial Start\r\n");if (OS_ThreadCreate(&g_main_thread, "ROSThread", ROSThread, NULL,OS_THREAD_PRIO_APP, 4 * 1024) != OS_OK) {printf("[ERR] Create MainThread Failed\n");}
}SYS_RUN(ROSMain);
8.1.3 编译程序
 hb build -f

可能会遇到下面问题:
在这里插入图片描述

这个flash分配的分配有问题:

cd 到 device/xradio/xr806/xr_skylark/project/demo/audio_demo/image/xr806

用文件image_auto_cal.cfg中的内容覆盖image_wlan_ble.cfg中的内容。

8.2 PC ROS端

Ubuntu版本:20版(18版也可以使用)

8.2.1 创建ros空间
mkdir -p rosworkspace/src
cd  rosworkspace
catkin_make
8.2.2 编写发布节点
import rospy
from std_msgs.msg import Stringif __name__ == "__main__":#2.初始化 ROS 节点:命名(唯一)rospy.init_node("talker_p")#3.实例化 发布者 对象pub = rospy.Publisher("ROS_to_XR860",String,queue_size=10)#4.组织被发布的数据,并编写逻辑发布数据msg = String()  #创建 msg 对象msg_front = "hello XR806    "count = 0  #计数器 # 设置循环频率rate = rospy.Rate(1)while not rospy.is_shutdown():#拼接字符串msg.data = msg_front + str(count)pub.publish(msg)rate.sleep()#rospy.loginfo("写出的数据:%s",msg.data)count += 1

修改CMakeLists.txt

catkin_install_python(PROGRAMSscripts/test_pub.pyDESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION}
)
8.2.3 启动节点
  1. 启动主节点:
roscore
  1. 起动test_pub节点
source ./devel/setup.bashrosrun ros_test test_pub.py 
  1. 启用serial_node节点:

串口:

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

如果串口连接成功,终端显示:

INFO] [1640087588.757505]: ROS Serial Python Node
[INFO] [1640087588.762633]: Connecting to /dev/ttyUSB0 at 115200 baud
[INFO] [1640087591.079099]: Requesting topics...
[INFO] [1640087591.131236]: Note: publish buffer size is 512 bytes
[INFO] [1640087591.134777]: Setup publisher on XR806_to_ROS [std_msgs/String]
[INFO] [1640087591.142147]: Note: subscribe buffer size is 512 bytes
[INFO] [1640087591.144610]: Setup subscriber on ROS_to_XR860 [std_msgs/String]

注意查看串口的权限,如果权限不足,先开启权限:

# 查看权限
ll /dev/ttyUSB*
#开启权限
sudo chmod 777 /dev/ttyUSB*

TCP
默认节点11411

rosrun rosserial_python serial_node.py tcp

如果TCP连接成功,终端显示:

[INFO] [1640232707.758952]: ROS Serial Python Node
[INFO] [1640232707.763597]: Fork_server is: False
[INFO] [1640232707.764688]: Waiting for socket connections on port 11411
[INFO] [1640232707.765650]: Waiting for socket connection
[INFO] [1640232724.857086]: Established a socket connection from 192.168.43.49 on port 60872
[INFO] [1640232724.859268]: calling startSerialClient
[INFO] [1640232726.966374]: Requesting topics...
[INFO] [1640232727.289246]: Note: publish buffer size is 512 bytes
[INFO] [1640232727.290573]: Setup publisher on XR806_to_ROS [std_msgs/String]
[INFO] [1640232727.295084]: Note: subscribe buffer size is 512 bytes
[INFO] [1640232727.296294]: Setup subscriber on ROS_to_XR860 [std_msgs/String]

8.3 结果查询

  1. ROS上查看话题:
 rostopic list /ROS_to_XR860
/XR806_to_ROS
/diagnostics
/rosout
/rosout_agg

可见 /ROS_to_XR860和/XR806_to_ROS两个话题

  1. 查看/XR806_to_ROS
rostopic echo /ROS_to_XR860data: "hello world!"
---
data: "hello world!"
---
data: "hello world!"
---
data: "hello world!"
---
data: "hello world!"
---
  1. 查看XR806接收的 /ROS_to_XR860话题消息

串口连接

-------- star ROS----------------
resive:hello XR806    1
resive:hello XR806    2
resive:hello XR806    3
resive:hello XR806    4
resive:hello XR806    5
resive:hello XR806    6
resive:hello XR806    7
resive:hello XR806    8
resive:hello XR806    9
resive:hello XR806    10
resive:hello XR806    11
resive:hello XR806    12

TCP连接

--------- star ROS----------------
connect tcp_server successfuly! 
resive:hello XR806    1
resive:hello XR806    2
resive:hello XR806    3
resive:hello XR806    4
resive:hello XR806    5
resive:hello XR806    6
resive:hello XR806    7
resive:hello XR806    8

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/news/692411.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

测试开发【Mock平台】14基础:拦截器服务实现(五) 规则查询代码

【Mock平台】为系列测试开发教程&#xff0c;从0到1编码带你一步步使用Spring Boot 和 Antd React框架完成搭建一个测试工具平台&#xff0c;希望作为一个实战项目对各位的测试开发学习之路有帮助&#xff0c;关注公众号发送“mock”获取github项目源码地址&#xff0c;大奇一个…

ctfshow-web29~40-WP

web29 if(isset($_GET[c])){$c = $_GET[c];if(!preg_match("/flag/i", $c)){eval($c);}}else{highlight_file(__FILE__); } 首先先system(“ls”);查看一下文件 既然过滤了flag,那我们就fla*的形式进行匹配,结合tac命令输出flag.php文件内容

拿捏c语言指针(下)

前言 此篇讲解的主要是函数与指针的那些事~ 书接上回 拿捏c语言指针&#xff08;上&#xff09;和 拿捏c语言指针&#xff08;中&#xff09; ​​​​​​没有看的小伙伴要抓紧喽~ 欢迎关注​​个人主页&#xff1a;逸狼 创造不易&#xff0c;可以点点赞吗~ 如有错误&#x…

有哪些好用的网页原型网站?

与桌面端相比&#xff0c;在线网页原型网站的使用具有优势&#xff0c;因为在线网页原型网站在整个使用过程中不需要安装&#xff0c;在线网页原型网站在任何地方都没有限制。更重要的是&#xff0c;无论是现在使用的Linux&#xff0c;在线网页原型网站在操作系统中都没有限制、…

一.重新回炉Spring Framework: 理解Spring IoC

1. 写在前面的话 说实话&#xff0c;从事java开发工作时间也不短了&#xff0c;对于Spring Framework&#xff0c;也是天天用&#xff0c;这期间也碰到了很多问题&#xff0c;也解决了很多问题。可是&#xff0c;总感觉对Spring Framework还是一知半解&#xff0c;不能有个更加…

苍穹外卖学习-----2024/02/19

1.开发环境搭建 我的git截图我使用的datagrip 运行sql学习到jwt令牌一种新的配置方式&#xff0c;写配置文件学习到了build属性nginx解决跨域的问题2.导入接口的文档 结果如图所示 3.Swagger /*** 通过knife4j生成接口文档* return*/Beanpublic Docket docket() {ApiInfo api…

深度学习基础——卷积神经网络(一)

卷积操作与自定义算子开发 卷积是卷积神经网络中的基本操作&#xff0c;对于图像的特征提取有着关键的作用&#xff0c;本文首先介绍卷积的基本原理与作用&#xff0c;然后通过编写程序实现卷积操作&#xff0c;并展示了均值、高斯与sobel等几种经典卷积核的卷积效果&#xff…

kafka的安装,用于数据库同步数据

1.0 背景调研 因业务需求&#xff0c;需要查询其他部门的数据库数据&#xff0c;不方便直连数据库&#xff0c;所以要定时将他们的数据同步到我们的环境中&#xff0c;技术选型选中了kafkaCDC Kafka是Apache旗下的一款分布式流媒体平台&#xff0c;Kafka是一种高吞吐量、持久…

Stable Diffusion——stable diffusion基础原理详解与安装秋叶整合包进行出图测试

前言 在2022年&#xff0c;人工智能创作内容&#xff08;AIGC&#xff09;成为了AI领域的热门话题之一。在ChatGPT问世之前&#xff0c;AI绘画以其独特的创意和便捷的创作工具迅速走红&#xff0c;引起了广泛关注。随着一系列以Stable Diffusion、Midjourney、NovelAI等为代表…

vue i18n element 使用

1. 首先下载 i18n包 npm install vue-i18n 2. 在src下创建 lang文件夹&#xff0c;存放语言配置文件&#xff08;index.js&#xff09;&#xff0c;语言包 2.1 语言配置文件 index.js import Vue from vue import VueI18n from vue-i18n // 从语言包文件中导入语言包对象 im…

智能风控体系之Y定义与样本选择(A卡)

评分卡模型设计里面&#xff0c;最重要的一环就是Y的定义和好坏样本的选择&#xff0c;即样本范围选择和Y变量确定。一般来说&#xff0c;产品评分卡开发需要有需求、设计、开发、测试、部署上线等过程。需要思考几个问题&#xff1a; 1.需要做几个评分卡模型&#xff0c;根据…

【动态规划】:路径问题_下降路径最小和

朋友们、伙计们&#xff0c;我们又见面了&#xff0c;本专栏是关于各种算法的解析&#xff0c;如果看完之后对你有一定的启发&#xff0c;那么请留下你的三连&#xff0c;祝大家心想事成&#xff01; C 语 言 专 栏&#xff1a;C语言&#xff1a;从入门到精通 数据结构专栏&…

OpenGL学习——17.模型

前情提要&#xff1a;本文代码源自Github上的学习文档“LearnOpenGL”&#xff0c;我仅在源码的基础上加上中文注释。本文章不以该学习文档做任何商业盈利活动&#xff0c;一切著作权归原作者所有&#xff0c;本文仅供学习交流&#xff0c;如有侵权&#xff0c;请联系我删除。L…

C# CAD交互界面-自定义面板集-comboBox选择图层

运行环境Visual Studio 2022 c# cad2016 一、代码说明 SelectLayer方法是一个自定义的AutoCAD命令方法&#xff0c;通过[CommandMethod("SelectLayer")]进行标记。方法首先获取当前活动文档&#xff0c;并检查是否有效。创建一个名为"SelectLayer"的Pale…

【复现】XMall 开源商城 SQL注入漏洞_54

目录 一.概述 二 .漏洞影响 三.漏洞复现 1. 漏洞一&#xff1a; 四.修复建议&#xff1a; 五. 搜索语法&#xff1a; 六.免责声明 一.概述 XMall基于SOA架构的分布式电商购物商城 前后端分离 前台商城:Vue全家桶 后台管理系统 二 .漏洞影响 攻击者未经授权可以访问数据库…

ES 在单个节点的查询并发限制是多少?增加分片一定会提高聚合/查询速度吗

背景 对于搜索集群而言&#xff0c;小节点多节点化一般是最佳实践。对于OLAP/日志集群而言&#xff0c;难以避免使用大节点&#xff08;单节点高配置&#xff09;&#xff0c;因为太多节点容易造成master的压力。对于OLAP集群而言单节点可能存在数百甚至数千shard。此时我们就…

使用 RAG 创建 LLM 应用程序

如果您考虑为您的文件或网站制作一个能够回应您的个性化机器人&#xff0c;那么您来对地方了。我可以帮助您使用Langchain和RAG策略来创建这样一个机器人。 了解ChatGPT的局限性和LLMs ChatGPT和其他大型语言模型&#xff08;LLMs&#xff09;经过广泛训练&#xff0c;以理解…

Leetcoder Day16| 二叉树 part05

语言&#xff1a;Java/C 513.找树左下角的值 给定一个二叉树的 根节点 root&#xff0c;请找出该二叉树的 最底层 最左边 节点的值。 假设二叉树中至少有一个节点。 示例 1: 输入: root [2,1,3] 输出: 1示例 2: 输入: [1,2,3,4,null,5,6,null,null,7] 输出: 7 本题需要满足两…

在vue事件中传入$event,使用e.target和e.currentTarget有什么区别

在Vue中&#xff0c;事件处理是前端开发中非常重要的一部分。当我们在Vue中处理事件时&#xff0c;经常会用到事件对象event&#xff0c;而在事件对象中&#xff0c;有两个常用的属性&#xff1a;e.target和e.currentTarget。这两个属性在使用上有些细微的差别&#xff0c;本文…

备战蓝桥杯---数学之矩阵快速幂基础

我们先不妨看一道题&#xff1a; 看见n的数据范围就知道直接按以前的递归写肯定狗带&#xff0c;那我们有什么其他的方法吗&#xff1f; 下面是分析&#xff1a; 我们就拿斐波那契数列试试手吧&#xff1a; 下面是AC代码&#xff0c;可以当作模板记&#xff1a; #include<b…