STM32 使用microros与ROS2通信_ros2 stm32

本文主要介绍如何在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 publisher
    rcl_timer_t timer_pub;
    RCCHECK(rclc_timer_init_default(
        &timer_pub,
        &support,
        RCL_MS_TO_NS(5),
        publisher_callback));
 
    // create executor
    executor = 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