STM32 使用microros与ROS2通信

本文主要介绍如何在STM32中使用microros与ROS2进行通信，在ROS1中标准的库是rosserial,在ROS2中则是microros,目前网上的资料也有一部分了，但是都没有提供完整可验证的demo，本文将根据提供的demo一步步给大家进行演示。

1、首先如果你用的不是STM32F4的话，则需要自己去生成micro_ros_stm32cubemx_utils库，博文demo使用的硬件是STM32F407芯片，提供的micro_ros_stm32cubemx_utils库也是F4的，工程目录如下图所示：

工程使用STM32CubeMX软件进行端口硬件等代码的初始化，大家在开发中可以对stattobotMicroros.ioc文件进行编辑，本文不对STM32CubeMX的使用进行讲解，大家可以自行百度学习。

2、micro_ros_stm32cubemx_utils使用提供了中断读写和DMA读写的接口，大家根据自己实际使用的端口对文件，dma_transports.c,it_transport.c

3、microros_tasks.c是microsros初始化和节点发布订阅的文件，

void starrobot_microros_init(void){MX_USART1_UART_Init();rmw_ret_t status = rmw_uros_set_custom_transport(true,(void *) &huart1,cubemx_transport_open,cubemx_transport_close,cubemx_transport_write,cubemx_transport_read);rcl_allocator_t freeRTOS_allocator = rcutils_get_zero_initialized_allocator();freeRTOS_allocator.allocate = microros_allocate;freeRTOS_allocator.deallocate = microros_deallocate;freeRTOS_allocator.reallocate = microros_reallocate;freeRTOS_allocator.zero_allocate =  microros_zero_allocate;if (!rcutils_set_default_allocator(&freeRTOS_allocator)) {printf("Error on default allocators (line %d)\n", __LINE__); }
}

该函数主要是对硬件进行注册绑定，使用的硬件，打开、关闭、读写、函数与microros的接口进行绑定。

void run_starrobotSTM_node(void){   // initial configurations starrobot_microros_init();init_starrobotSTM_node();create_starrobotSTM_publisher();create_starrobotSTM_subscriber();// timer for publisherrcl_timer_t timer_pub;RCCHECK(rclc_timer_init_default(&timer_pub,&support,RCL_MS_TO_NS(5),publisher_callback));// create executorexecutor = rclc_executor_get_zero_initialized_executor();RCCHECK(rclc_executor_init(&executor, &support.context, 2, &allocator));RCCHECK(rclc_executor_add_timer(&executor, &timer_pub));RCCHECK(rclc_executor_add_subscription(&executor, &subscriber, &sub_msg, &subscription_callback, ON_NEW_DATA));// spin node by executor while(1){rcl_ret_t rc = rclc_executor_spin(&executor); //, RCL_MS_TO_NS(100)if (rc != RCL_RET_OK){break;}}// rclc_executor_fini(&executor);
}

该函数是整个节点的封装函数，包含了注册绑定硬件和创建发布、订阅节点。

大家下载demo包后，需要先在vscode中配置开发ARM的环境，然后make jflash进行编译下载即可；下载完成后打开ROS2端运行Agent 指令:<sudo docker run -it --rm -v /dev:/dev -v /dev/shm:/dev/shm --privileged --net=host microros/micro-ros-agent:$ROS_DISTRO serial --dev /dev/ttyUSB0 -v>,使用<ros2 node list> <ros2 topic list> <ros2 topic info /topic_name>查看发布的节点信息和数据。

相关demo代码下载地址：https://gitee.com/starRureole/starrobot_microros.git

如果大家有CSDN积分，想支持一下博主的，可以在CSDN上下载：https://download.csdn.net/download/qq_36349536/87500333

同时也欢迎大家进群一起交流学习：129923584

相关视频讲解链接：https://www.bilibili.com/video/BV1bD4y1g7V5/

博文使用的开发板购买链接：https://item.taobao.com/item.htm?spm=a1z10.1-c-s.w4004-21142386790.2.c0086177uv5IlA&id=606445592295