3、机器人软件架构概览：感知-规划-控制-通信的典型分层与数据流

机器人软件架构是连接硬件资源与智能行为的桥梁。在RTOS（实时操作系统）环境下设计任务之前，必须先理解机器人软件的整体分层逻辑。典型的机器人软件架构遵循“感知-规划-控制-通信”四层模型，每一层承担不同的职责，层与层之间通过明确的数据流接口交互。本章将深入剖析这一分层模型的核心原理、数据流向、任务映射方法，并结合实际案例说明如何在RTOS中落地这一架构。

3.1 核心原理：四层架构的职责边界与数据耦合

机器人软件架构的核心思想是关注点分离。感知层负责“理解世界”，规划层负责“决定做什么”，控制层负责“具体怎么做”，通信层负责“信息如何流动”。这种分层不是简单的代码组织方式，而是对实时性、确定性、模块复用性的系统性设计。

在RTOS环境中，每一层对应一组具有不同优先级和周期特性的任务。感知层任务通常以较高频率（如10-100Hz）运行，处理传感器原始数据；规划层任务频率较低（如1-10Hz），但计算量大；控制层任务必须硬实时（如500Hz-1kHz），直接驱动执行器；通信层任务则穿插在各层之间，负责数据搬运。

数据流的方向并非单向的“感知→规划→控制”。实际系统中存在大量反馈回路：控制层的执行结果通过传感器反馈回感知层，形成闭环；规划层需要感知层的环境模型，但也要接收控制层的执行状态（如是否到达目标点）。这种双向数据流要求RTOS任务设计必须考虑数据同步、缓存一致性和时序约束。

3.2 判断方法：如何将功能模块映射为RTOS任务

将四层架构落地为RTOS任务，需要遵循一套系统化的判断流程。以下是常用的五步法：

1. 识别功能模块的实时性需求：硬实时（如电机控制）→ 高优先级周期任务；软实时（如路径规划）→ 中优先级任务；非实时（如日志记录）→ 低优先级任务。
2. 分析数据依赖关系：绘制数据流图，标注每个模块的输入/输出数据、数据产生频率、最大允许延迟。例如，控制层需要以固定周期获取最新传感器数据，而规划层可以容忍稍旧的数据。
3. 确定任务周期与优先级：控制任务周期最短（1-5ms），感知任务次之（10-100ms），规划任务最长（100ms-1s）。优先级与控制频率正相关，但需考虑优先级反转问题。
4. 评估计算资源消耗：测量每个功能模块在最坏情况下的执行时间（WCET），确保在任务周期内能完成计算。若超时，需拆分任务或优化算法。
5. 设计任务间通信机制：根据数据大小和实时性要求选择消息队列、共享内存、信号量或事件标志组。高频小数据用共享内存+信号量，低频大数据用消息队列。

3.3 案例拆解：室内移动机器人导航系统的任务划分

以一个典型的室内轮式移动机器人导航系统为例，说明四层架构如何映射为具体的RTOS任务。该机器人配备激光雷达、IMU、轮式编码器和单线摄像头，需要实现自主导航功能。

系统约束与目标：机器人最大线速度1.5m/s，控制周期要求5ms（200Hz），激光雷达扫描频率10Hz，IMU输出频率200Hz，全局路径规划在收到目标点后1秒内完成，局部避障响应时间小于100ms。

初始现象与问题：初版设计中，所有功能集中在一个大循环中顺序执行，导致控制周期抖动严重（最差达到15ms），机器人行走时出现明显抖动，且遇到动态障碍物时避障响应延迟超过300ms。

分析过程：通过RTOS的跟踪工具（如FreeRTOS的trace功能）发现，激光雷达点云处理（约8ms）和全局规划计算（约50ms）阻塞了控制输出。进一步分析数据流发现，控制任务需要最新的位姿数据，但位姿估计（IMU+编码器融合）与激光雷达处理耦合在同一任务中。

重构方案：按照四层架构重新划分任务：

任务列表（按优先级从高到低）：
1. 电机控制任务 (优先级5, 周期2ms) - 读取编码器, 计算PID, 输出PWM
2. 运动学解算任务 (优先级4, 周期5ms) - 将速度指令转为轮速指令
3. 位姿估计任务 (优先级3, 周期5ms) - 融合IMU+编码器数据
4. 激光雷达采集任务 (优先级3, 周期10Hz) - 触发采集, 发布原始点云
5. 点云处理任务 (优先级2, 周期10Hz) - 分割、聚类、障碍物提取
6. 局部规划任务 (优先级2, 周期20Hz) - DWA避障, 生成局部轨迹
7. 全局规划任务 (优先级1, 事件触发) - A*路径搜索
8. 通信任务 (优先级1, 中断驱动) - ROS2话题收发
9. 日志任务 (优先级0, 后台) - 数据记录

实施步骤：首先将电机控制从主循环中剥离，使用硬件定时器触发；然后为位姿估计单独建立任务，通过共享内存向控制任务提供最新位姿；最后将激光雷达处理和全局规划降为低优先级任务，并增加消息队列缓冲。

结果对比：重构后，控制周期稳定在2ms±0.1ms，避障响应时间降至80ms以内，全局规划在500ms内完成。机器人行走平稳，动态避障性能显著提升。

风险与代价：任务数量从1个增加到9个，内存占用增加约15KB（用于任务栈和消息队列），调试复杂度上升。但系统整体实时性和可维护性大幅提升。

复盘经验：任务划分的核心不是“功能拆分”，而是“时序解耦”。将不同频率、不同实时性要求的功能分离到独立任务中，才能让RTOS的调度器发挥真正作用。

3.4 常见误区与总结复盘

在机器人RTOS任务设计中，工程师常犯以下错误：

• 误区一：任务划分过细。每个传感器一个任务，导致任务切换开销过大，系统吞吐量下降。建议将相同频率、相同优先级的功能合并为一个任务。
• 误区二：忽视数据同步。多个任务共享同一份数据时，未使用互斥锁或原子操作，导致数据竞争和状态不一致。应优先使用RTOS提供的同步机制。
• 误区三：优先级设置不合理。将通信任务设为最高优先级，导致控制任务被抢占，引发执行器抖动。通信任务应使用中断+低优先级处理的方式。
• 误区四：没有考虑优先级反转。低优先级任务持有共享资源，阻塞高优先级任务。应使用优先级继承或优先级天花板协议。
• 误区五：所有任务都用周期执行。事件驱动的任务（如收到新目标点）也使用固定周期轮询，浪费CPU资源。应使用事件标志组或消息队列触发。

总结：感知-规划-控制-通信四层架构是机器人软件设计的通用框架，它帮助工程师将复杂的机器人系统分解为可管理、可测试、可扩展的模块。在RTOS环境中，每一层对应一组具有明确优先级、周期和数据接口的任务。正确的任务划分能够保证系统的实时性、确定性和可维护性，是机器人产品稳定运行的基础。本章通过案例展示了从功能模块到RTOS任务的完整映射过程，并总结了常见的设计误区。在实际项目中，应结合具体硬件平台、算法复杂度和产品需求，灵活运用这一架构模型。