3、uORB消息机制：uORB是什么、消息发布与订阅、自定义uORB消息、消息调试技巧

各位同学，今天我们来聊聊PX4里最核心的通信机制——uORB。说实话，我第一次接触PX4源码时，最困惑的就是各个模块之间到底怎么传数据的。后来搞明白了uORB，整个系统架构就豁然开朗了。

3.1 uORB是什么？

uORB，全称是micro Object Request Broker。名字挺长，说白了就是一个轻量级的发布-订阅消息总线。它负责让PX4里各个模块互相通信。

你想想看，一个飞控系统里有几十个模块：传感器驱动、姿态估计、位置控制、导航……它们之间需要交换数据。如果每个模块都直接调用对方的API，那代码就乱成一锅粥了。uORB就是来解决这个问题的。

我个人习惯把uORB想象成一个「消息黑板报」。任何模块都可以往黑板上贴消息（发布），也可以从黑板上读消息（订阅）。发布者和订阅者互不知道对方的存在，耦合度极低。

下面这张图展示了uORB在PX4系统中的位置和作用：

3.2 消息发布与订阅

好，理论说完了，咱们直接看代码。uORB的发布和订阅API非常简洁，我总结成三步走：

3.2.1 订阅消息

订阅一个消息，只需要调用 orb_subscribe() 函数。它会返回一个文件描述符，后续用这个描述符来读取数据。

// 订阅传感器加速度计数据
int sensor_sub = orb_subscribe(ORB_ID(sensor_accel));

// 设置订阅频率（可选）
orb_set_interval(sensor_sub, 10); // 10ms更新一次

// 读取数据
struct sensor_accel_s accel_data;
orb_copy(ORB_ID(sensor_accel), sensor_sub, &accel_data);

这里有个细节要注意：orb_subscribe() 默认会拿到最新的一帧数据。如果你需要历史数据，可以用 orb_subscribe_multi() 创建多个订阅实例。

3.2.2 发布消息

发布消息更简单，三步走：

1. 声明消息结构体变量
2. 填充数据
3. 调用 orb_publish()

// 声明并填充数据
struct sensor_accel_s accel_data;
accel_data.timestamp = hrt_absolute_time();
accel_data.x = 0.01f;
accel_data.y = -0.02f;
accel_data.z = -9.81f;

// 发布消息
orb_publish(ORB_ID(sensor_accel), &accel_data);

嗯，这里要注意时间戳。我见过不少新手忘记给 timestamp 赋值，导致下游模块拿到的是0值，整个控制链路就乱了。

3.2.3 发布频率控制

发布频率不是越高越好。我曾经在一个项目中把IMU数据发布频率设到了2kHz，结果CPU负载飙升，反而导致系统不稳定。

消息类型	推荐频率	说明
传感器原始数据	1kHz	IMU、磁力计等
姿态估计结果	200-500Hz	EKF输出
位置/速度	50-100Hz	GPS融合后
遥控器信号	50Hz	RC输入

3.3 自定义uORB消息

有时候系统自带的uORB消息不够用，比如你要加一个自定义的传感器。这时候就需要自己定义消息了。

步骤很简单，就三步：

1. 在 msg/ 目录下创建 .msg 文件
2. 运行编译工具生成C/C++代码
3. 在驱动中使用

3.3.1 定义消息文件

假设我们要定义一个超声波测距消息：

# 文件: msg/ultrasonic_distance.msg
uint64 timestamp        # 时间戳，微秒
float32 distance        # 距离，单位米
float32 confidence      # 置信度，0.0-1.0
uint8 sensor_id         # 传感器ID

消息字段支持的类型包括：uint8/16/32/64、int8/16/32/64、float32/64、bool，以及数组。

3.3.2 编译生成代码

在PX4源码根目录下运行：

make px4_fmu-v5_default

编译系统会自动解析 .msg 文件，生成对应的头文件。你可以在 build/<target>/msg/ 目录下找到生成的代码。

3.3.3 在驱动中使用自定义消息

#include <uORB/uORB.h>
#include <msg/ultrasonic_distance.h>

// 发布自定义消息
struct ultrasonic_distance_s dist_data;
dist_data.timestamp = hrt_absolute_time();
dist_data.distance = 1.25f;
dist_data.confidence = 0.98f;
dist_data.sensor_id = 1;

orb_advert_t pub = orb_advertise(ORB_ID(ultrasonic_distance), &dist_data);
orb_publish(ORB_ID(ultrasonic_distance), pub, &dist_data);

3.4 消息调试技巧

调试uORB消息是开发过程中最常做的事。我总结了几条实用技巧：

3.4.1 使用listener命令

在nsh终端里，listener 命令是最常用的调试工具：

# 查看所有活跃的消息
listener

# 查看特定消息
listener sensor_accel

# 查看多个消息
listener sensor_accel sensor_gyro vehicle_attitude

这个命令会实时打印消息内容，频率默认1Hz。你可以用 -n 参数指定打印次数，用 -r 参数指定频率。

3.4.2 使用uorb top命令

想知道哪个消息发布频率最高？用 uorb top：

nsh> uorb top
  #   TOPIC                    INST  #SUB  #PUB  RATE(Hz)
  1   sensor_accel             0     3     1     1000
  2   sensor_gyro              0     3     1     1000
  3   vehicle_attitude         0     2     1     250
  4   vehicle_local_position   0     1     1     100

这个命令能帮你快速定位消息发布异常的问题。比如某个消息的发布频率突然掉到0，那肯定是驱动挂了。

3.4.3 日志分析

如果现场调试不方便，可以用ulog日志：

# 启动日志记录
logger on

# 只记录特定消息
logger topics sensor_accel sensor_gyro

日志文件可以用 ulog2csv 工具转换成CSV，然后用Python或Excel分析。我在一次飞行测试中，就是通过分析日志发现GPS消息偶尔会丢失，最终定位到是硬件中断冲突的问题。

好了，uORB的核心内容就这些。说白了，它就是PX4的「神经系统」，所有数据都通过它来传递。掌握了发布、订阅、自定义和调试这四块，你就能在PX4里自由地玩转消息通信了。

---