1. 项目概述
作为一名嵌入式开发者，调试是日常开发中不可或缺的重要环节。在PX4飞控开发中，掌握有效的日志输出方法能极大提升开发效率。本文将详细介绍PX4系统中的日志输出机制，包括核心打印宏函数的使用、调试串口配置以及通过Mavlink协议与QGC地面站进行交互式调试的方法。
2. 核心打印宏函数解析
2.1 PX4日志系统设计理念
PX4系统不建议直接使用标准C库的printf函数，而是提供了一套完整的日志宏系统。这种设计主要基于以下几个考虑：
- 平台兼容性：PX4需要运行在多种硬件平台上，直接使用printf可能导致不同平台行为不一致
- 性能优化：专用日志宏可以针对嵌入式环境进行优化，减少内存和CPU开销
- 日志分级：支持不同级别的日志输出，便于按需过滤
- 输出重定向：可以灵活配置输出到串口、文件或网络
2.2 常用日志宏函数
PX4提供了多个级别的日志宏，最常用的包括：
cpp复制PX4_INFO("This is an info message"); // 普通信息
PX4_WARN("Warning: value=%d", value); // 警告信息
PX4_ERR("Error occurred!"); // 错误信息
PX4_DEBUG("Debug info"); // 调试信息(需开启DEBUG模式)
这些宏的使用方式与printf类似，但内部实现经过了专门优化。例如，PX4_INFO的实现会考虑当前系统的日志配置，自动选择最优的输出方式。
2.3 日志宏的高级用法
在实际开发中，我们还可以利用一些高级特性：
-
条件日志：使用PX4_INFO_COND宏，只在特定条件下输出
cpp复制PX4_INFO_COND(sensor_ready, "Sensor is ready"); -
带标签的日志：为日志添加模块标签
cpp复制PX4_INFO_NAMED("navigation", "Position updated"); -
性能关键区域的日志：使用PX4_INFO_RATE_LIMITED避免高频日志影响性能
cpp复制PX4_INFO_RATE_LIMITED(1000, "High frequency message"); // 每秒最多输出1次
提示：在性能敏感的区域，应避免使用高频日志输出。可以使用RATE_LIMITED版本或DEBUG级别的日志。
3. 调试终端串口配置
3.1 PX4串口系统架构
PX4的串口系统采用模块化设计，主要包含以下几个组件：
- 串口驱动层：负责底层硬件操作
- 串口管理模块：管理多个串口实例
- 日志后端：将日志输出路由到指定串口
- Mavlink模块：提供网络透明的串口转发功能
3.2 常用串口配置
在PX4中，串口通常通过板级配置文件进行定义。以常见的V6X飞控为例，其串口映射如下：
| 串口号 | 默认功能 | 可配置用途 |
|---|---|---|
| USART1 | Console | 调试输出 |
| USART2 | TELEM1 | Mavlink通信 |
| USART3 | TELEM2 | 备用通信/GPS |
| UART4 | GPS | GPS模块 |
| UART7 | RC输入 | 遥控器接收 |
| UART8 | 串口调试 | 用户自定义 |
3.3 启用调试串口输出
要使日志输出到特定串口，需要进行以下配置：
- 修改板级配置文件（如
boards/px4/fmu-v6x/default.px4board） - 设置串口功能：
bash复制
CONFIG_ARMV7M_USART1=y CONFIG_ARMV7M_USART1_BAUD=115200 CONFIG_ARMV7M_USART1_CONSOLE=y - 在代码中指定输出串口：
cpp复制int fd = px4_open("/dev/ttyS1", O_WRONLY); px4_dup2(fd, 1); // 重定向标准输出
注意：不同硬件平台的串口编号可能不同，请参考具体硬件的文档。配置错误的串口参数可能导致系统无法启动。
4. QGC终端调试实战
4.1 Mavlink终端调试原理
QGroundControl(QGC)通过Mavlink协议与飞控通信，其中MAVLink协议提供了专门的终端模拟功能。其工作原理如下：
- QGC发送MAV_CMD_REQUEST_MESSAGE命令请求终端数据
- 飞控通过SERIAL_CONTROL消息返回终端输出
- QGC解析并显示在"MAVLink Console"界面
4.2 代码实现解析
在PX4源码中，Mavlink终端功能主要由以下文件实现：
src/modules/mavlink/mavlink_main.cpp- Mavlink主模块src/modules/mavlink/mavlink_serial_control.cpp- 串口控制实现src/modules/logger/log_writer_file.cpp- 日志记录功能
关键代码片段：
cpp复制// 处理终端请求
if (serial_control->device == SERIAL_CONTROL_DEV_SHELL) {
int nread = read(serial_control->fd, buf, sizeof(buf));
if (nread > 0) {
mavlink_serial_control_t msg;
msg.count = nread;
memcpy(msg.data, buf, nread);
mavlink_msg_serial_control_send_struct(_mavlink_fd, &msg);
}
}
4.3 使用其他串口监视代码执行
除了通过QGC的MAVLink控制台，我们还可以使用其他串口工具直接监视特定串口的输出：
-
配置串口参数：
bash复制stty -F /dev/ttyUSB0 115200 raw -echo -echoe -echok -
使用screen工具查看：
bash复制
screen /dev/ttyUSB0 115200 -
使用minicom：
bash复制
minicom -D /dev/ttyUSB0 -b 115200 -
使用Python脚本读取：
python复制import serial ser = serial.Serial('/dev/ttyUSB0', 115200, timeout=1) while True: print(ser.readline().decode('utf-8'))
实操心得：在实际调试中，建议同时使用QGC终端和直接串口连接。QGC适合查看系统日志，而直接串口连接更适合调试时间敏感的代码，因为MAVLink协议会有一定的延迟。
5. 常见问题与解决方案
5.1 日志输出不显示
问题现象：代码中添加了PX4_INFO但看不到输出
排查步骤：
- 检查是否配置了正确的控制台串口
- 确认串口波特率设置正确
- 检查日志级别设置（
param set SDLOG_MODE 1启用调试日志） - 确认硬件连接正确（TX/RX线序）
5.2 串口输出乱码
可能原因：
- 波特率不匹配
- 流控设置错误
- 硬件电平不兼容（如3.3V与5V混用）
解决方案：
bash复制# 检查当前波特率
stty -F /dev/ttyS0
# 设置正确波特率
stty -F /dev/ttyS0 115200
5.3 MAVLink终端响应慢
优化建议：
- 增加MAVLink数据流速率：
bash复制
mavlink stream -r 20000 -s SERIAL_CONTROL - 减少其他MAVLink消息的发送频率
- 使用USB连接代替数传电台
5.4 日志文件过大
管理策略：
- 设置日志循环：
bash复制param set SDLOG_MODE 2 # 循环记录 param set SDLOG_DIRS_MAX 5 # 最多保留5个日志文件 - 按需启用日志：
bash复制param set SDLOG_PROFILE 1 # 只记录关键数据
6. 高级调试技巧
6.1 动态日志级别控制
PX4支持运行时修改日志级别：
bash复制# 设置特定模块的日志级别
logger level -m navigator -l debug
6.2 日志标记与过滤
在代码中添加特殊标记便于过滤：
cpp复制PX4_INFO("[NAV] Position updated"); // 添加模块前缀
然后在QGC中使用过滤器：
bash复制[NAV] # 只显示导航模块日志
6.3 多串口分流输出
对于复杂系统，可以将不同模块的日志输出到不同串口：
-
首先配置多个串口：
cpp复制px4_console_buffer_t buf1, buf2; px4_console_init(&buf1, "/dev/ttyS1"); px4_console_init(&buf2, "/dev/ttyS2"); -
然后定向输出：
cpp复制px4_console_print(&buf1, "Navigation output"); px4_console_print(&buf2, "Control output");
6.4 日志性能分析
使用系统资源监控工具分析日志性能影响：
bash复制top -p <px4-pid> # 查看CPU占用
free # 查看内存使用
dmesg | grep tty # 检查串口错误
在实际项目中，我发现合理配置日志系统可以节省30%以上的调试时间。特别是在飞行测试中，良好的日志策略能快速定位偶发问题。建议在项目初期就规划好日志系统，而不是在出现问题后才临时添加日志输出。