PX4的UORB通信机制

2024-08-31 00:08
文章标签 通信 机制 px4 uorb

本文主要是介绍PX4的UORB通信机制,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

在Firmware的msg文件夹里面,里面有很多.msg结尾的文件,这些msg文件在编译的时候可以生成h头文件,这些编译过程中生成的头文件一般是保存在build_default/src/module/uorb/topics。

添加msg文件的时候,首先把写好的msg文件放在msg文件夹里面,然后还有一个需要修改的就是cmakelist这个文件,要在这个文件里面把你的msg文件的名字加进去。

在写msg文件的时候注意不能用int,msg里面是没有int的,都是用uint16,uint8这种,曾经写了个int  i,这样生成的H头文件就是不对,就是int的问题。

老的PX4里面是没有这个cmakelist的。这个时候就是要在ORB_DEFINE里面手动添加上,详细的见下面2,

1.ORB_DECLARE在由msg文件生成的h头文件里面的最后一行会有一个ORB_DECLARE(status_led);这里的status_led就是tpoic的名字,这里的名字就是你在使用uorb的时候,比如说advertise函数的时候,ORB_ID后面括号里面的主题的名字。

2.ORB_DEFINE然后在objects_common.cpp通过ORB_DEFINE将主题的名字和结构体的定义关联起来。然后在发布或者copy的时候就要用ORB_DEFINE里面和主题关联起来的结构体,不能是把自己随便定义的一个结构体。(对于msg文件夹里面又cmakelist的情况,就不用手动的在objects_common里面手动的进行添加了)

3.发布端:然后接下来就是在发布的程序里面,首先需要定义结构体,例如:struct  esc_up-s  new_report;然后还需要定义主题句柄用来接收orb_advertise的返回值,例如:orb_advert_t  _esc_up_topic;注意orb_advertise函数的返回值是orb_advert_t类型的,而不是int型的。然后还需要定义主题ID用来作为函数orb-advertise的参数,例如orb_id_t        _esc_up_orb_id,这样定义的话在使用之前还需要用_esc_up_orb_id = ORB_ID(esc_up);进行赋值,然后就可以进行订阅和发布了,或者不用定义主题的ID,直接在公告的时候用,_esc_up_topic = orb_advertise(ORB_ID(esc_up), &new_report);这样就剩了一步了,然后就是进行公告和发布了。

          if (_esc_up_topic != nullptr) //NULL  in  cnullptr  in  c++

               {

                     orb_publish(_esc_up_orb_id, _esc_up_topic, &new_report);

            }

               else 

               {

                     _esc_up_topic = orb_advertise(_esc_up_orb_id, &new_report);

              if (_esc_up_topic == nullptr)

                     {

                          errx(1, "ADVERT FAIL");

                     }

                 }

4.接收端:然后就是在接收端了,接收端首先也是需要定义结构体用来保存接收到的值,例如:struct  esc_up_s  esc_up;然后也是需要定义一个用来接收主题句柄的变量,订阅函数subscribe的返回值不是orb_advert_t类型的,而是整型的,例如int _esc_up_orb_sub;然后就是进行订阅、check和copy了。

_esc_up_orb_sub = orb_subscribe(ORB_ID(esc_up));

         bool  updated;

         orb_check(_esc_up_orb_sub, &updated);

          if (updated)

         {

               orb_copy(ORB_ID(esc_up), _esc_up_orb_sub, & esc_up);

           }

在订阅的时候要注意,对于同一个topic,只订阅一次,要是多次订阅的话,那么你会发现,第一次订阅返回值是1,第二次订阅的返回值是2,第三次订阅的返回值是3,这样你下面check的时候永远不会更新,因为每次都是不同的主题了,又一次就是犯了这样的错误,注意,在订阅的时候可以用

If(0 == led_fd)

{

led_fd = orb_subscribe(ORB_ID(status_led))

}但是记住,led_fd定义之后要初始化为零,要不然不会进入这个if里面。

 

另外关于公告函数的返回值是orb_advert_t,订阅函数的返回值是int。这种问题不用问,直接自己看一下函数的返回值就可以了。

Uorb的时候,如果你订阅是在创建task之前,然后在taskmain里面进行check和copy,那么也是不成功的,理解为在一个线程中订阅的在另一个线程中不能使用吧。

 

这篇关于PX4的UORB通信机制的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/1122324

相关文章

基于C#实现MQTT通信实战

《基于C#实现MQTT通信实战》MQTT消息队列遥测传输,在物联网领域应用的很广泛,它是基于Publish/Subscribe模式,具有简单易用,支持QoS,传输效率高的特点,下面我们就来看看C#实现... 目录1、连接主机2、订阅消息3、发布消息MQTT(Message Queueing Telemetr

嵌入式Linux驱动中的异步通知机制详解

《嵌入式Linux驱动中的异步通知机制详解》:本文主要介绍嵌入式Linux驱动中的异步通知机制,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录前言一、异步通知的核心概念1. 什么是异步通知2. 异步通知的关键组件二、异步通知的实现原理三、代码示例分析1. 设备结构

JVM垃圾回收机制之GC解读

《JVM垃圾回收机制之GC解读》:本文主要介绍JVM垃圾回收机制之GC,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录一、死亡对象的判断算法1.1 引用计数算法1.2 可达性分析算法二、垃圾回收算法2.1 标记-清除算法2.2 复制算法2.3 标记-整理算法2.4

C++如何通过Qt反射机制实现数据类序列化

《C++如何通过Qt反射机制实现数据类序列化》在C++工程中经常需要使用数据类,并对数据类进行存储、打印、调试等操作,所以本文就来聊聊C++如何通过Qt反射机制实现数据类序列化吧... 目录设计预期设计思路代码实现使用方法在 C++ 工程中经常需要使用数据类,并对数据类进行存储、打印、调试等操作。由于数据类

SpringRetry重试机制之@Retryable注解与重试策略详解

《SpringRetry重试机制之@Retryable注解与重试策略详解》本文将详细介绍SpringRetry的重试机制,特别是@Retryable注解的使用及各种重试策略的配置,帮助开发者构建更加健... 目录引言一、SpringRetry基础知识二、启用SpringRetry三、@Retryable注解

SpringKafka错误处理(重试机制与死信队列)

《SpringKafka错误处理(重试机制与死信队列)》SpringKafka提供了全面的错误处理机制,通过灵活的重试策略和死信队列处理,下面就来介绍一下,具有一定的参考价值,感兴趣的可以了解一下... 目录引言一、Spring Kafka错误处理基础二、配置重试机制三、死信队列实现四、特定异常的处理策略五

java中反射(Reflection)机制举例详解

《java中反射(Reflection)机制举例详解》Java中的反射机制是指Java程序在运行期间可以获取到一个对象的全部信息,:本文主要介绍java中反射(Reflection)机制的相关资料... 目录一、什么是反射?二、反射的用途三、获取Class对象四、Class类型的对象使用场景1五、Class

Nginx之upstream被动式重试机制的实现

《Nginx之upstream被动式重试机制的实现》本文主要介绍了Nginx之upstream被动式重试机制的实现,可以通过proxy_next_upstream来自定义配置,具有一定的参考价值,感兴... 目录默认错误选择定义错误指令配置proxy_next_upstreamproxy_next_upst

Spring排序机制之接口与注解的使用方法

《Spring排序机制之接口与注解的使用方法》本文介绍了Spring中多种排序机制,包括Ordered接口、PriorityOrdered接口、@Order注解和@Priority注解,提供了详细示例... 目录一、Spring 排序的需求场景二、Spring 中的排序机制1、Ordered 接口2、Pri

MySQL 缓存机制与架构解析(最新推荐)

《MySQL缓存机制与架构解析(最新推荐)》本文详细介绍了MySQL的缓存机制和整体架构,包括一级缓存(InnoDBBufferPool)和二级缓存(QueryCache),文章还探讨了SQL... 目录一、mysql缓存机制概述二、MySQL整体架构三、SQL查询执行全流程四、MySQL 8.0为何移除查