STM32 使用microros与ROS2通信

2023-05-16

本文主要介绍如何在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

本文内容由网友自发贡献,版权归原作者所有,本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容,请联系:hwhale#tublm.com(使用前将#替换为@)

STM32 使用microros与ROS2通信 的相关文章

  • pppBayesTree工程在ubuntu16.04的vscode下调试

    从下面这个链接中获取代码 xff0c 其他链接有些make操作的错误 xff0c 在下面这个链接中我改好了 bryantaoli PPP BayesTree 参考下面这个配置vscode VScode单步调试 fb 941219的博客 CS

随机推荐