首页 > 其他分享 >【ROS2机器人入门到实战】你的第一个MicroROS节点

【ROS2机器人入门到实战】你的第一个MicroROS节点

时间:2023-09-07 15:32:33浏览次数:46  
标签:RCL allocator support rcl MicroROS ROS2 microros 节点 rclc


2.你的第一个MicroROS节点

写在前面

  1. 当前平台文章汇总地址:ROS2机器人从入门到实战
  2. 获取完整教程及配套资料代码,请关注公众号<鱼香ROS>获取
  3. 教程配套机器人开发平台:两驱版| 四驱版
  4. 为方便交流,搭建了机器人技术问答社区:地址 fishros.org.cn

你好,我是爱吃鱼香ROS的小鱼。上一节我们介绍了MicroROS和Agent的安装,本节我们开始正是编写代码,接入ROS2。

一、新建工程添加依赖

1.1 新建工程

新建example10_hello_microros工程,这里需要更改下工程的位置,默认目录是在文档目录下,小鱼在测试时发现目录定位上有bug,所以建议建议直接放到主目录或其下目录,小鱼这里直接放到主目录。

【ROS2机器人入门到实战】你的第一个MicroROS节点_ROS2

1.2 添加依赖

打开platform.ini,接着我们添加MicroROS的依赖。

[env:featheresp32]
platform = espressif32
board = featheresp32
framework = arduino
lib_deps = 
    https://gitee.com/ohhuo/micro_ros_platformio.git

这里使用的地址并不是MicroROS官方仓库,而是小鱼经过修改后的国内仓库地址,里面放置了小鱼编译好后可以直接使用的microros静态库,并对仓库中需要梯子的地址进行了替换。

二、编写代码-第一个节点

开始编写代码,因为Micro-ROS遵循RCLC-API,所以这里小鱼通过一个最简单的例程介绍如何新建一个节点。

#include <Arduino.h>
#include <micro_ros_platformio.h>

#include <rcl/rcl.h>
#include <rclc/rclc.h>
#include <rclc/executor.h>

rclc_executor_t executor;
rclc_support_t support;
rcl_allocator_t allocator;
rcl_node_t node;

void setup()
{
  Serial.begin(115200);
  // 设置通过串口进行MicroROS通信
  set_microros_serial_transports(Serial);
  // 延时时一段时间,等待设置完成
  delay(2000);
  // 初始化内存分配器
  allocator = rcl_get_default_allocator();
  // 创建初始化选项
  rclc_support_init(&support, 0, NULL, &allocator);
  // 创建节点 hello_microros
  rclc_node_init_default(&node, "hello_microros", "", &support);
  // 创建执行器
  rclc_executor_init(&executor, &support.context, 1, &allocator);
}

void loop()
{
  delay(100);
  // 循环处理数据
  rclc_executor_spin_some(&executor, RCL_MS_TO_NS(100));
}

上面代码并不复杂,小鱼已经将注释写上,强烈建议你跟着代码敲一遍,不要直接复制粘贴。

相比在上位机中开发ROS,这里多了几步

  • 设置通信协议,因为可以通过多种方式连接,所以需要进行提前设置
  • 初始化内存分配器,在微控制器上资源受限,内存的管理要很细致
  • 创建初始化选项,用于初始化rcl并创建一些需要用到的数据结构体

关于rclc的api小鱼并没有找到文档,不过源码的头文件依然非常清晰,直接安装Ctrl点击某个函数即可跳转(不行的,重启下Vscode)。

比如关于rclc_support_init 的源码及参数介绍。

/**
 *  Initializes rcl and creates some support data structures.
 *  Initializes clock as RCL_STEADY_TIME.
 *  * <hr>
 * Attribute          | Adherence
 * ------------------ | -------------
 * Allocates Memory   | Yes (in RCL)
 * Thread-Safe        | No
 * Uses Atomics       | No
 * Lock-Free          | Yes
 *
 * \param[inout] support a zero-initialized rclc_support_t
 * \param[in] argc number of args of main
 * \param[in] argv array of arguments of main
 * \param[in] allocator allocator for allocating memory
 * \return `RCL_RET_OK` if RCL was initialized successfully
 * \return `RCL_RET_INVALID_ARGUMENT` if any null pointer as argument
 * \return `RCL_RET_ERROR` in case of failure
 */
RCLC_PUBLIC
rcl_ret_t
rclc_support_init(
  rclc_support_t * support,
  int argc,
  char const * const * argv,
  rcl_allocator_t * allocator);

三、运行测试

连接开发板,编译下载,如果遇到端口被占用,多半是你的microros_agent没有关闭,Ctrl+C打断运行再次尝试。

【ROS2机器人入门到实战】你的第一个MicroROS节点_#include_02

接着打开Agent

【ROS2机器人入门到实战】你的第一个MicroROS节点_ROS2_03

然而并没有什么反应,重新点击一次RST即可看到有数据发送和接收过来了。

【ROS2机器人入门到实战】你的第一个MicroROS节点_ROS2_04

接着打开新的终端,输入指令

ros2 node list
ros2 node info /hello_microros

【ROS2机器人入门到实战】你的第一个MicroROS节点_#include_05

可以看到,我们的第一个节点成功运行起来了。

四、总结

本节我们成功的在微控制器平台上将MicroROS节点运行起来了,下一节我们开始正式进行ROS2通信的学习。


标签:RCL,allocator,support,rcl,MicroROS,ROS2,microros,节点,rclc
From: https://blog.51cto.com/u_15473553/7397679

相关文章

  • 【ROS2机器人入门到实战】话题订阅-控制LED
    1.话题订阅-控制LED写在前面当前平台文章汇总地址:ROS2机器人从入门到实战获取完整教程及配套资料代码,请关注公众号<鱼香ROS>获取教程配套机器人开发平台:两驱版|四驱版为方便交流,搭建了机器人技术问答社区:地址fishros.org.cn你好,我是爱吃鱼香ROS的小鱼。本节我们正式进入到MicroRO......
  • 【ROS2机器人入门到实战】Micro-ROS介绍与服务安装
    1.Micro-ROS介绍与服务安装写在前面当前平台文章汇总地址:ROS2机器人从入门到实战获取完整教程及配套资料代码,请关注公众号<鱼香ROS>获取教程配套机器人开发平台:两驱版|四驱版为方便交流,搭建了机器人技术问答社区:地址fishros.org.cn你好,我是爱吃鱼香ROS的小鱼。本节我们主要介绍下......
  • 力扣---1123. 最深叶节点的最近公共祖先
    给你一个有根节点 root 的二叉树,返回它 最深的叶节点的最近公共祖先 。回想一下:叶节点 是二叉树中没有子节点的节点树的根节点的 深度 为 0,如果某一节点的深度为 d,那它的子节点的深度就是 d+1如果我们假定 A 是一组节点 S 的 最近公共祖先,S 中的每个节点都在......
  • 查看linux 操作系统版本、节点名称、架构等
    #uname-aLinuxtankcheng-Legion-Y9000P-IAH7H5.15.0-83-generic#92~20.04.1-UbuntuSMPMonAug2114:00:49UTC2023x86_64x86_64x86_64GNU/Linux操作系统:Linux节点名称:ttankcheng-Legion-Y9000P-IAH7H操作系统发型版号:5.15.0-83-generic系统版本与时间:#92~20.04.1......
  • JavaScript--查找当前节点的父节点
    consttreeData=(item)=>{if(item.parent&&item.parent.length>0){let_parent=data.taskData.filter((data)=>data.id==item.parent);if(_parent&&_parent.length>0){if(da......
  • 【Leetcode刷题记录】1、统计参与通信的服务器;2、统计二叉树中好节点的数目;3、从两个
    1、统计参与通信的服务器题目:这里有一幅服务器分布图,服务器的位置标识在 m*n 的整数矩阵网格 grid 中,1表示单元格上有服务器,0表示没有。如果两台服务器位于同一行或者同一列,我们就认为它们之间可以进行通信。请你统计并返回能够与至少一台其他服务器进行通信的服务器的......
  • Elasticsearch7.8集群实践记录之下线节点
    1.背景:由于机房迁移需要将elasticsearch集群进行跨机房搬迁,采取先扩容再收缩的方式进行,已有效减小对业务环境的影响。当前需要将老的节点有序下线。2.操作步骤:  1.检查集群配置,保证主节点的可用性;   #设置minimum_master_nodes为2curl-XPUT'http://hostname:9......
  • 【ROS2机器人入门到实战】学会使用按键-GPIO输入
    3.学会使用按键-GPIO输入写在前面当前平台文章汇总地址:ROS2机器人从入门到实战获取完整教程及配套资料代码,请关注公众号<鱼香ROS>获取教程配套机器人开发平台:两驱版|四驱版为方便交流,搭建了机器人技术问答社区:地址fishros.org.cn你好,我是爱吃鱼香ROS的小鱼。上一节完成了LED灯的......
  • 【ROS2机器人入门到实战】嵌入式开发之从点灯开始
    第十三章嵌入式开发之从点灯开始写在前面当前平台文章汇总地址:ROS2机器人从入门到实战获取完整教程及配套资料代码,请关注公众号<鱼香ROS>获取教程配套机器人开发平台:两驱版|四驱版为方便交流,搭建了机器人技术问答社区:地址fishros.org.cn你好,我是小鱼。本章开始我们将一起走进机......
  • 【ROS2机器人入门到实战】使用开源库驱动IMU
    2.使用开源库驱动IMU写在前面当前平台文章汇总地址:ROS2机器人从入门到实战获取完整教程及配套资料代码,请关注公众号<鱼香ROS>获取教程配套机器人开发平台:两驱版|四驱版为方便交流,搭建了机器人技术问答社区:地址fishros.org.cn你好,我是爱吃鱼香ROS的小鱼。上一节我们安装好了MPU605......