17自由度云端情绪陪伴机器人运动控制系统开发总结
17自由度云端情绪陪伴机器人运动控制系统开发总结
一、项目背景
本项目以17自由度人形机器人为载体，基于 SmartRobot2025 上位机软件和 SmartRobot 32 路舵机控制器，完成机器人从硬件组装、舵机校准、动作开发到复合动作设计的完整开发流程，并为后续接入云端 Agent、情绪识别和情绪陪伴系统提供运动控制基础。
项目目标不仅是让机器人“能够运动”，更重要的是让机器人具备基础交互能力和情绪表达能力，使其能够完成礼仪动作、舞蹈动作、交通指挥动作以及边走边招手等复合交互动作，逐步形成具有表达性和互动性的情绪陪伴机器人。
整个开发过程涉及：
- 机器人机械结构理解与自由度分析
- 多舵机协同控制
- 串口通信协议与PWM控制
- 舵机偏差补偿与软件校准
- 行为建模与关键帧建模
- 多自由度轨迹规划
- 动态平衡控制与步态规划
- 动作镜像生成与动作复用
- 多动作融合与分层控制设计
项目最终完成多个稳定运行的动作组，并逐步形成了一套完整的机器人动作开发方法论。
二、硬件平台搭建
1. 17自由度人形机器人组装
按照安装说明书完成机器人从零部件到完整结构的搭建。
机器人主要由：
下肢结构
- 大脚板
- 脚踝关节
- 小腿结构
- 大腿结构
- 胯部连接机构
上肢结构
- 躯干
- 肩部
- 手臂
- 手腕
共同组成完整的人形机器人。
17个自由度赋予机器人：
- 双腿独立运动能力
- 双臂独立运动能力
- 躯干姿态调整能力
- 礼仪与情绪表达能力
在组装过程中，逐渐理解到：
机械结构决定运动能力上限。
任何支架安装误差、舵盘安装角度偏差以及螺丝固定误差，都会直接影响后续动作精度和稳定性。因此，硬件组装不仅是零件拼接，更是理解机器人运动学结构和关节布局的过程。
2. 舵机安装与校准
所有舵机出厂默认中位：
P1500安装时需要保证：
- 舵机回中
- 金属舵盘与结构件对齐
- 左右肢体保持对称
随后建立偏差（B值）校准文件：
实际输出位置 = P值 + B值例如：
P1500 B +50 实际输出： 1550通过逐个关节微调，使机器人达到：
- 手臂自然下垂
- 双腿略微后弯
- 左右姿态对称
- 站姿稳定
最终完成17个舵机的偏差校准。
这一阶段本质上完成了：
机械误差的软件补偿。
使后续动作文件能够在不同机器人之间复用，而无需重新修改全部动作数据。
三、控制系统开发
机器人采用 SmartRobot 32 路舵机控制器进行控制。
系统连接方式：
USB ↓ 串口驱动 ↓ 115200波特率 ↓ SmartRobot2025上位机 ↓ 32路舵机控制器 ↓ PWM输出 ↓ 舵机执行动作单舵机控制指令：
#5 P1600 T500表示：
5号舵机在500ms内运动到1600位置。
多舵机同步控制：
#5 P1600 #6 P1200 #7 P1800 T500控制器负责：
动作指令 ↓ 串口协议解析 ↓ PWM信号生成 ↓ 舵机驱动 ↓ 机器人运动控制器实际上完成了：
高层动作指令到底层硬件控制的转换。
四、机器人动作开发流程
整个动作开发过程并不是简单拖动舵机，而是逐步形成了一套完整的运动控制设计流程。
第一步：动作需求分析
首先根据机器人的应用场景，结合AI建议，筛选适合开发的动作。
主要开发了三类动作：
礼仪动作
- 挥手
- 致谢
- 鞠躬
表演动作
- 舞蹈
- 交通指挥
运动动作
- 前进两步
- 前进招手
动作筛选主要考虑三个维度：
1）语义表达能力
动作能否传递明确含义。
例如：
挥手表示问候；
致谢表示礼仪；
交通指挥表示引导。
2）机械可实现性
17自由度是否能够完成该动作。
3）动作稳定性
动作是否容易导致机器人失衡或摔倒。
这个阶段实际上先确定：
做什么动作。
第二步：舵机功能分解
在确定动作方向后，首先根据17个舵机的位置布局和机械结构，对舵机进行功能分工。
下半身舵机（#3~#12）
主要负责：
- 脚踝旋转
- 脚掌翻转
- 膝关节弯曲
- 髋关节运动
- 重心转移
- 行走步态
例如：
6号和9号舵机：
负责抬腿动作；
7号和8号舵机：
负责脚板左右翻转和重心调整。
它们直接决定机器人：
能否站稳；
能否完成单脚支撑；
能否实现稳定行走。
上半身舵机（#21~#27）
主要负责：
- 肩部旋转
- 手臂抬升
- 肘部动作
- 躯干姿态调整
承担：
- 情绪表达
- 礼仪动作
- 交互展示
例如：
挥手动作主要使用：
#21~#27而前进动作主要使用：
#3~#12这种分层思想为后续复合动作融合奠定了基础。
第三步：动作建模
确定动作后，并没有立即调舵机，而是先进行动作抽象建模。
核心思想：
将连续动作拆解为若干关键姿态。
例如：
挥手
站立 ↓ 抬手 ↓ 向左摆动 ↓ 向右摆动 ↓ 停顿 ↓ 收手 ↓ 回中前进两步
站立 ↓ 重心左移 ↓ 右腿抬起 ↓ 右腿落地 ↓ 重心右移 ↓ 左腿抬起 ↓ 左腿落地 ↓ 恢复站立交通指挥
站立 ↓ 抬手 ↓ 发出指令 ↓ 停顿强化 ↓ 切换方向 ↓ 收回致谢动作
站稳 ↓ 身体偏转 ↓ 抬手 ↓ 致谢停顿 ↓ 回收动作 ↓ 恢复站立这一阶段实际上完成的是：
行为建模（Behavior Modeling）
以及：
关键帧建模（Keyframe Modeling）
机器人动作由连续运动问题，转化为：
有限关键姿态序列问题。
第四步：关键帧数据构建
确定关键姿态后，开始在 SmartRobot2025 上位机中逐帧调试。
流程如下：
舵机回中
P1500↓
调整单个舵机
观察：
- 手臂姿态
- 腿部姿态
- 身体倾斜
- 重心变化
↓
调整多个舵机协同
形成目标姿态。
例如：
鞠躬动作：
腿部后移 + 躯干前倾 + 手臂自然下垂并不是一次完成，而是不断循环：
观察 ↓ 修改 ↓ 在线运行 ↓ 重新调整经过大量试错，逐渐得到每个关键姿态的舵机数据。
最终形成：
<Table1><ID>5</ID><Move>#3 P1802 #4 P1477 ……</Move><Time>T750</Time></Table1>每一帧本质上就是：
17维关节空间中的一个离散姿态点。
第五步：关键帧串联与轨迹生成
当所有关键帧稳定后，再按照动作逻辑进行串联。
例如：
挥手：
12帧；
前进两步：
12帧；
舞蹈：
148帧；
前进招手：
32帧。
每一帧由：
Move + Time共同组成：
姿态点 + 时间轴控制器会自动完成：
上一帧
↓
当前帧
之间的位置插值。
因此机器人动作本质上已经不再是简单的位置跳变，而是：
多自由度关节轨迹规划问题。
第六步：时间参数调优
在开发过程中发现：
时间参数甚至比姿态参数更加重要。
例如：
前进动作：
T400速度快；
容易摔倒。
T550基本稳定。
T700非常稳定；
但动作缓慢。
因此需要不断调整：
- T200
- T300
- T500
- T700
- T1000
寻找：
动作表现
与
机器人稳定性
之间的平衡。
第七步：在线调试与脱机验证
每个动作均经历：
在线运行
观察：
- 是否抖动
- 是否卡死
- 是否碰撞
- 是否倾倒
- 是否存在动作突变
发现问题立即修改。
随后：
下载至控制器Flash
进行：
脱机运行验证
确保机器人脱离电脑后仍能够稳定独立执行动作。
第八步：动作优化与复用
随着动作数量增加，逐渐形成动作库思想。
礼仪动作库
- 挥手
- 致谢
- 鞠躬
表演动作库
- 舞蹈
- 交通指挥
运动动作库
- 前进
- 前进招手
同时掌握：
镜像生成技术
例如：
左致谢
↓
参数镜像
↓
右致谢
无需重新开发。
显著提升了动作开发效率。
五、复合动作开发——前进招手
项目后期完成了复合动作：
前进招手
开发流程：
动作拆解
前进：
负责步态。
挥手：
负责表达。
分层控制
下半身：
#3~#12负责：
动态平衡；
步态规划；
重心转移。
上半身：
#21~#27负责：
招手表达；
情绪展示。
时间轴对齐
统一：
- T1000
- T750
- T500
- T300
使：
走路节奏
与
招手节奏
保持同步。
幅度衰减
实验发现：
直接融合挥手动作容易导致机器人侧翻。
因此采用：
新幅度 = 原幅度 × 衰减系数减小：
上半身横向扰动。
最终实现：
前进招手动作成功率：
10/10实现机器人边前进边招手的复合交互效果。
六、阶段性成果与技术收获
本阶段共完成：
硬件部分
- 17自由度机器人组装
- 17个舵机安装与校准
- 偏差文件建立
基础控制部分
- SmartRobot2025环境搭建
- 串口通信配置
- PWM控制理解
- 多舵机联动控制
动作开发部分
- 挥手动作
- 鞠躬动作
- 致谢动作
- 交通指挥动作
- 前进两步动作
- 148帧舞蹈动作编排
- 前进招手复合动作
方法论积累
形成了一套完整的机器人动作开发流程：
动作需求分析
→ 舵机功能分解
→ 行为建模
→ 关键帧设计
→ 上位机逐帧调试
→ 轨迹生成与时间规划
→ 在线验证
→ 脱机验证
→ 动作优化与复用
→ 复合动作融合
七、总结
通过本项目，开发思维逐渐从：
调一个舵机让机器人动起来
提升到：
将机器人动作视为多自由度系统的轨迹规划、动态平衡控制和行为建模问题。
项目不仅完成了多个稳定运行的动作文件，更形成了：
关键帧建模 + 分层控制 + 时间轴规划 + 动态平衡优化 + 动作复用生成
的一整套机器人运动控制开发方法，为后续接入云端 Agent、情绪识别以及智能情绪陪伴系统奠定了坚实的运动控制基础。