📚 课程目录第4章开发环境搭建

4. 开发环境搭建

各位同学，今天我们来聊聊PX4里最核心的通信机制——uORB。我常说，如果把飞控比作一个人，那uORB就是它的神经系统。没有它，各个模块之间就是信息孤岛，飞控根本跑不起来。

说白了，uORB就是一个轻量级的进程间通信（IPC）机制。它让PX4里不同的任务模块——比如姿态估计、位置控制、GPS驱动——能够高效地交换数据。我刚开始接触PX4时，第一件事就是搞懂uORB怎么玩，因为几乎所有自定义功能的开发都绕不开它。

核心要点：uORB采用发布/订阅模型，支持一对多、多对多的通信方式。发布者只管发，订阅者只管收，两者完全解耦。

4.1 uORB的工作原理

uORB的全称是“Micro Object Request Broker”，微对象请求代理。名字挺唬人，其实原理很简单：

消息主题（Topic）：每个数据通道都有一个唯一的名字，比如sensor_accel、vehicle_attitude。
发布者（Publisher）：往主题里写数据，比如IMU驱动发布加速度计数据。
订阅者（Subscriber）：从主题里读数据，比如姿态估计模块订阅加速度计数据。
消息队列：每个主题维护一个环形缓冲区，暂存最新数据。

我记得有一次调试一个奇怪的延时问题，查了半天发现是订阅者处理太慢，导致消息队列溢出。嗯，这里要提醒大家：uORB默认只保留最新的一条消息，订阅者如果跟不上发布者的节奏，就会丢数据。

我的经验：在调试阶段，可以用uorb top命令查看各主题的发布频率和订阅情况，快速定位通信瓶颈。

4.2 发布/订阅模型详解

发布/订阅模型的好处是模块之间完全解耦。发布者不需要知道谁在订阅，订阅者也不需要关心数据从哪来。这种设计让PX4的模块化程度非常高。

我画了一张图，帮你理解这个模型：

你看，发布者（蓝色）只管往uORB总线里写数据，订阅者（紫色）只管从总线里读数据。它们之间没有直接依赖关系。这种设计让系统非常灵活——你可以随时增加或移除模块，不影响其他部分。

4.3 自定义消息定义（.msg文件）

实际项目中，系统自带的那些消息类型往往不够用。比如你要加一个自定义传感器，或者传输一些特殊的调试数据，那就得自己定义消息了。

定义消息很简单，创建一个.msg文件就行。我习惯把它们放在msg/目录下。来看一个例子：

# 文件: msg/my_custom_sensor.msg
uint64 timestamp        # 时间戳，单位微秒
float32[3] acceleration # 三轴加速度，m/s²
float32[3] gyroscope    # 三轴角速度，rad/s
float32 temperature     # 温度，摄氏度
uint8 quality           # 数据质量，0-100

这里有几个要点：

第一行必须是时间戳，类型为uint64，字段名必须是timestamp。这是PX4的约定，几乎所有消息都带这个字段。
支持基本类型：uint8、int32、float32、bool等。
支持数组：用方括号指定长度，比如float32[3]。
支持嵌套：可以引用其他消息类型。

注意：我曾经犯过一个错误——在消息里定义了一个string类型的字段。结果编译通过了，但运行时内存分配出了问题。uORB的消息结构必须是固定大小的，不能包含变长字段。所以，别用string，用固定长度的char[]代替。

定义好.msg文件后，需要在CMakeLists.txt里注册一下：

# 在 msg/CMakeLists.txt 中添加
set(msg_files
    ...
    my_custom_sensor.msg
    ...
)

然后重新编译，PX4会自动生成对应的C/C++头文件。生成的文件在build/<target>/msg/目录下，比如my_custom_sensor.h。

4.4 消息发布与订阅API

消息定义好了，接下来就是怎么用。uORB提供了几个核心API，我一个个讲。

4.4.1 发布消息

发布消息分三步：先广告（advertise），再发布（publish）。

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

// 1. 声明消息结构体
struct my_custom_sensor_s sensor_data;
sensor_data.timestamp = hrt_absolute_time();
sensor_data.acceleration[0] = 0.1f;
sensor_data.acceleration[1] = 0.2f;
sensor_data.acceleration[2] = 9.8f;
sensor_data.temperature = 25.5f;
sensor_data.quality = 95;

// 2. 广告主题（只做一次）
orb_advert_t pub = orb_advertise(ORB_ID(my_custom_sensor), &sensor_data);

// 3. 循环中发布数据
while (true) {
    sensor_data.timestamp = hrt_absolute_time();
    // 更新传感器数据...
    orb_publish(ORB_ID(my_custom_sensor), pub, &sensor_data);
    usleep(10000); // 100Hz
}

这里有个细节：orb_advertise只需要调用一次，它会返回一个orb_advert_t句柄。后续的orb_publish都用这个句柄。我个人习惯把广告操作放在模块初始化阶段。

4.4.2 订阅消息

订阅更简单，三步走：订阅、检查更新、拷贝数据。

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

// 1. 订阅主题
int sub = orb_subscribe(ORB_ID(my_custom_sensor));

// 2. 设置队列长度（可选）
orb_set_interval(sub, 10); // 最小间隔10ms

// 3. 循环中读取数据
struct my_custom_sensor_s sensor_data;
while (true) {
    bool updated;
    orb_check(sub, &updated);
    if (updated) {
        orb_copy(ORB_ID(my_custom_sensor), sub, &sensor_data);
        // 处理数据...
        printf("温度: %.2f°C\n", sensor_data.temperature);
    }
    usleep(5000); // 200Hz
}

你可能会问：为什么不用orb_copy直接读，还要先orb_check？嗯，这里有个性能考虑。如果订阅频率比发布频率低，orb_check可以避免不必要的拷贝操作。我一般都会先检查再拷贝，养成好习惯。

4.4.3 常用API一览

API函数	功能	使用场景
`orb_advertise()`	广告一个主题，成为发布者	模块初始化时调用一次
`orb_publish()`	发布数据到主题	数据更新时循环调用
`orb_subscribe()`	订阅一个主题	模块初始化时调用一次
`orb_check()`	检查是否有新数据	循环中先检查再读取
`orb_copy()`	拷贝最新数据到本地	确认有新数据后调用
`orb_set_interval()`	设置订阅最小间隔	控制订阅频率，避免CPU过载
`orb_unsubscribe()`	取消订阅	模块退出时清理资源

避坑指南：我曾经在中断服务函数里直接调用orb_publish，结果系统死锁了。uORB的API不是中断安全的，不要在中断上下文里调用。正确的做法是在中断里只做标记，在主循环里发布数据。

4.5 实战：自定义一个调试消息

光说不练假把式。我带你走一遍完整的流程，从定义消息到发布订阅。

第一步：定义消息

在msg/目录下创建debug_info.msg：

uint64 timestamp
float32 pid_p
float32 pid_i
float32 pid_d
float32 target_value
float32 actual_value
uint8[4] debug_flags

第二步：注册消息

在msg/CMakeLists.txt里加上debug_info.msg。

第三步：编译

make px4_fmu-v5_default

第四步：写发布者代码

// 在PID控制器模块中
#include <uORB/uORB.h>
#include <msg/debug_info.h>

static orb_advert_t debug_pub = nullptr;
struct debug_info_s debug_data;

void pid_controller_init() {
    memset(&debug_data, 0, sizeof(debug_data));
    debug_pub = orb_advertise(ORB_ID(debug_info), &debug_data);
}

void pid_controller_update(float p, float i, float d, float target, float actual) {
    debug_data.timestamp = hrt_absolute_time();
    debug_data.pid_p = p;
    debug_data.pid_i = i;
    debug_data.pid_d = d;
    debug_data.target_value = target;
    debug_data.actual_value = actual;
    orb_publish(ORB_ID(debug_info), debug_pub, &debug_data);
}

第五步：写订阅者代码

// 在调试日志模块中
#include <uORB/uORB.h>
#include <msg/debug_info.h>

void debug_logger_task() {
    int sub = orb_subscribe(ORB_ID(debug_info));
    orb_set_interval(sub, 100); // 10Hz记录
    
    struct debug_info_s data;
    while (true) {
        bool updated;
        orb_check(sub, &updated);
        if (updated) {
            orb_copy(ORB_ID(debug_info), sub, &data);
            // 写入SD卡或通过串口输出
            printf("PID: P=%.3f I=%.3f D=%.3f | Target=%.2f Actual=%.2f\n",
                   data.pid_p, data.pid_i, data.pid_d,
                   data.target_value, data.actual_value);
        }
        usleep(10000);
    }
}

你看，整个过程并不复杂。定义消息、广告、发布、订阅、拷贝，就这五步。但就是这五步，构成了PX4整个系统的通信骨架。