4. uORB消息机制详解

uORB（micro Object Request Broker）是 PX4 内部模块之间进行异步数据交换的核心中间件。它并不是一个网络通信协议，而是一套基于共享内存的轻量级发布/订阅系统。飞控中的传感器驱动、姿态估计、控制律、导航、日志、MAVLink 等模块，都通过 uORB 主题（topic）交换数据。理解 uORB 的发布订阅流程、队列与缓冲区管理、更新通知机制以及多实例与优先级处理，是进行 PX4 二次开发和 ROS2 接口桥接的基础。

一、发布与订阅的基本流程

uORB 的每个主题在编译期由 .msg 文件生成对应的 C 结构体和元数据。发布者调用 orb_advertise() 或 orb_advertise_multi() 注册主题，获得一个 orb_advert_t 句柄；随后通过 orb_publish() 写入数据。订阅者调用 orb_subscribe() 获得订阅句柄，再通过 orb_copy() 读取最新数据。整个过程不经过内核网络栈，而是直接操作共享内存中的主题实例。

发布与订阅的典型代码结构如下：

// 发布者
orb_advert_t pub = orb_advertise(ORB_ID(sensor_combined), &data);
orb_publish(ORB_ID(sensor_combined), pub, &new_data);

// 订阅者
int sub = orb_subscribe(ORB_ID(sensor_combined));
struct sensor_combined_s buf;
orb_copy(ORB_ID(sensor_combined), sub, &buf);

发布者与订阅者之间是解耦的：发布者不需要知道谁在订阅，订阅者也不需要知道数据由谁产生。这种解耦使得 PX4 的模块可以独立启动、停止和替换，非常适合飞控这种多任务、多速率并存的系统。

二、消息队列与缓冲区管理

uORB 为每个主题维护一个或多个实例，每个实例内部包含一个环形缓冲区（ring buffer）。缓冲区的大小由主题定义中的 ORB_QUEUE_LENGTH 决定，默认通常为 1，表示只保留最新一帧数据。对于高频传感器数据，如果订阅者处理速度跟不上发布速度，缓冲区可以设置为更大的值，从而保留若干历史帧，避免数据丢失。

缓冲区管理的关键点在于：

• 最新数据优先：当队列长度为 1 时，新数据直接覆盖旧数据，订阅者永远读到最新值。
• 历史数据保留：当队列长度大于 1 时，发布者写入新数据，订阅者按顺序读取，适合需要连续帧的场景，如日志记录或滤波。
• 内存开销：队列越长，共享内存占用越大。PX4 在资源受限的飞控上通常只对关键主题增加队列长度。
• 多实例隔离：每个实例拥有独立的缓冲区，互不干扰。

三、消息更新通知机制

订阅者如何知道有新数据到达？uORB 提供了两种方式：轮询和阻塞等待。轮询方式使用 orb_check() 检查是否有更新，适合在固定周期任务中使用；阻塞方式使用 px4_poll() 等待文件描述符可读，适合事件驱动任务。

// 轮询方式
bool updated;
orb_check(sub, &updated);
if (updated) {
    orb_copy(ORB_ID(sensor_combined), sub, &buf);
}

// 阻塞方式
struct pollfd fds = { .fd = sub, .events = POLLIN };
if (px4_poll(&fds, 1, 1000) > 0) {
    orb_copy(ORB_ID(sensor_combined), sub, &buf);
}

更新通知的底层依赖 uORB 内部的信号量或条件变量。发布者写入数据后，会唤醒等待该主题的订阅者。对于多实例主题，每个实例独立通知，订阅者需要指定实例编号。理解这一点对 ROS2 桥接尤为重要：ROS2 节点通常以固定频率轮询 uORB 主题，再转换为 DDS 消息发布出去。

四、多实例与优先级处理

多实例用于同一主题存在多个数据源的情况。例如 vehicle_command 可能来自地面站、遥控器或机载计算机；sensor_combined 可能来自多个 IMU。uORB 通过 orb_advertise_multi() 创建多个实例，每个实例有独立的句柄和缓冲区。订阅者可以通过 orb_subscribe_multi() 订阅指定实例，也可以订阅所有实例并逐一读取。

优先级处理体现在两个方面：一是发布者可以通过 orb_publish() 的优先级参数影响实例选择；二是订阅者可以根据数据来源、时间戳或质量指标选择使用哪个实例。例如在双 IMU 系统中，PX4 的 sensors 模块会根据校准状态和一致性检查，选择主 IMU 数据发布到 sensor_combined，而备用 IMU 数据保留在独立实例中。

五、典型场景与常见误区

以姿态控制为例：sensors 模块以 1kHz 发布 sensor_combined，ekf2 模块以 250Hz 订阅并融合，mc_att_control 以 1kHz 订阅 vehicle_attitude 和 vehicle_angular_velocity。如果 ekf2 处理过慢，sensor_combined 的队列长度若为 1，则 ekf2 只能读到最新帧，中间帧被覆盖；若队列长度设为 4，则 ekf2 可以连续读取多帧，但会增加延迟和内存。实际调参时需要权衡实时性与完整性。

在 ROS2 接口开发中，通常使用 px4_ros_com 或 micro-ROS 桥接。桥接节点会为每个 uORB 主题创建一个订阅，并以固定频率读取最新数据，再发布为 ROS2 话题。此时需要特别注意：uORB 主题的更新频率可能远高于 ROS2 节点的发布频率，因此桥接节点应使用轮询方式读取最新值，而不是阻塞等待每一帧，否则会造成消息积压和延迟累积。

总结来看，uORB 的发布订阅流程围绕共享内存和环形缓冲区展开，更新通知机制决定了订阅者的读取时机，多实例与优先级处理则解决了多数据源竞争问题。掌握这些机制后，无论是调试 PX4 内部模块，还是开发 ROS2 桥接节点，都能更准确地定位数据延迟、丢帧和实例选择错误等问题。