上一节第 6 章 BusLinker舵机控制器开发 从20Hz到100Hz串口通信的血泪史第二部分串口舵机——从协议到实战第 7 章 舵机控制的高级话题 速度曲线、扭矩管理、通信可靠性、寿命维护——那些规格书不会告诉你的真相前两章讲了怎么让舵机动起来、怎么搭一个100Hz的控制器。但如果你以为「能控制舵机」就等于「能用好舵机」那你还差得远。这一章不讲协议不讲代码框架讲的是我在实际使用中碰到的那些「阴暗面」——速度曲线怎么选、堵转怎么保护、指令丢了怎么办、舵机用久了会怎样。以下内容全部来自实测希望能帮你少走弯路。7.1 舵机速度与加速度控制7.1.1 move_time一个被低估的参数move_time是舵机协议中最重要的参数没有之一。它告诉舵机从当前位置转到目标位置需要花多少毫秒。这个参数同时影响速度和加速度。我第一次测试时把move_time设成0ms——心想「越快越好嘛」。结果舵机像打了鸡血一样发出刺耳的啸叫声执行命令整个人像个格斗选手一样。因为move_time0意味着舵机以最大功率加速到达目标位置后急停惯性导致机械系统产生振荡。然后我试了1000ms——确实不抖了但问题变成了滞后你发指令让它抬腿它慢悠悠地抬等你指令让它落脚了它腿还没抬到位。在100Hz的控制循环中舵机永远追不上目标位置。经过反复测试我们最终把move_time定在8ms。这个数字不是拍脑袋决定的而是基于100Hz控制循环的精确计算。7.1.2 8ms的设计逻辑100Hz控制频率意味着每10ms发一次指令。如果move_time等于控制周期可能出现的情况是舵机还没完成上次运动新指令就到了导致运动不连续微观上表现为「一顿一顿」的微抖动。所以我们需要move_time略小于控制周期。8ms是一个经过验证的值舵机在10ms内完成运动剩余2ms留给串口传输和舵机内部处理。核心原则move_time应该略小于控制周期给通信和计算留出余量。move_time的选择原则move_time 控制周期 - 2ms。对于100Hz10ms周期move_time 8ms对于50Hz20ms周期move_time 16ms。不要设0ms会抖动不要超过控制周期会滞后。7.1.3 梯形速度 vs S曲线为什么我们选梯形舵机内部的速度曲线有两种梯形速度曲线加速-匀速-减速和S曲线平滑加速。梯形速度计算简单舵机MCU处理快缺点是加速和减速阶段有「拐点」——加速度突变产生微小冲击。S曲线运动极其平滑但计算复杂对MCU算力要求高。HTD-45H舵机内部使用的是梯形速度曲线。因为它的MCU性能有限S曲线计算量太大。而且梯形速度的拐点冲击在机械系统里被齿轮间隙和结构件柔性吸收掉了实际表现并不差。示波器抓取的位置响应曲线显示梯形速度在拐点处有约0.3°的超调但50ms内就收敛了。对118元一个的舵机来说梯形速度是务实的选择。7.1.4 速度限制316°/s从哪来HTD-45H的规格书说转速0.18 sec/60°。换算60° / 0.18s 333°/s空载最大转速。但实际负载条件下舵机能达到的最大转速约316°/s。我们在行走步态规划中每一步的角度变化都限制在316°/s以内确保舵机始终能跟上指令。超过这个速度控制器以为舵机转到了目标角度实际它没到累积误差越来越大最终机器人失去平衡。参数空载值负载实测值说明最大转速333°/s316°/s负载下约95%空载性能move_time0ms不可用8ms100Hz控制周期下的最优值加速度瞬时梯形曲线舵机内置梯形速度位置超调0.2°0.3°梯形拐点处的微小超调收敛时间N/A50ms超调后50ms内收敛7.1.5 梯形速度曲线的数学实现虽然舵机内部已经实现了梯形速度但理解它的数学原理对你调试运动参数很有帮助。梯形速度曲线分为三个阶段加速段加速度恒定、匀速段速度恒定、减速段减速度恒定。三个阶段的持续时间由目标角度差和move_time共同决定。以下是在控制层实现梯形速度规划的代码——不是给舵机执行的而是用于上层轨迹规划确保每次发给舵机的角度增量在速度限制以内deftrapezoidal_step(current,target,max_vel,dt):单步梯形速度规划 current: 当前角度 (deg) target: 目标角度 (deg) max_vel: 最大速度 (deg/s), HTD-45H316 dt: 控制周期 (s), 10ms0.01 returns: 下一步角度 (deg) errortarget-current max_stepmax_vel*dt# 单步最大角度变化ifabs(error)max_step:returntarget# 足够近, 直接到位else:# 限制在最大速度内returncurrentmath.copysign(max_step,error)这个函数特别简单但极其有效。它确保了每次发给舵机的角度增量不会超过316°/s * 0.01s 3.16°。对于大角度运动比如从站立到迈步需要转动30°经过约10个控制周期100ms就能到达目标舵机完全跟得上。你也可以在这个基础上实现更精细的S曲线。S曲线的核心思想是让加速度本身也平滑变化——用加加速度jerk来限制加速度的变化率。但说实话对于HTD-45H这种舵机S曲线的效果提升微乎其微因为它的齿轮间隙和机械柔性已经起到了天然的“平滑器”作用。这里有一个我在调试时学到的经验如果你发现舵机在拐点处有微小的“咯噔”声那不是梯形速度的问题而是齿轮间隙造成的。减小move_time不会消除这个声音反而会让它更明显。正确的做法是检查齿轮间隙是否过大超过0.15mm就需要更换或者给关键帧之间增加过渡时间。7.2 舵机负载与扭矩管理45kg·cm的扭矩听起来很大但在实际使用中你会发现有时候够用有时候不够。关键是理解在什么情况下不够以及如何保护舵机不被烧毁。7.2.1 45kg·cm在实际中的表现45kg·cm意味着舵机在1cm力臂处能输出45kg的力在10cm力臂处能输出4.5kg的力。我们的机器人腿长约30cm髋关节能输出的力是45kg·cm / 30cm 1.5kg。机器人总重约3kg两条腿各承担1.5kg——刚好够。但这是静态站立的情况。走路时一条腿支撑全身重量另一条腿抬起来。支撑腿的髋关节要承受3kg的力而我们刚算出来髋关节只能输出1.5kg——问题来了。实际上45kg·cm是堵转扭矩运动扭矩通常小于堵转扭矩但动态条件下舵机还需要克服惯性力。走路时髋关节的负载峰值接近额定扭矩的90%是系统的瓶颈。7.2.2 堵转检测电流3A与温度70°C舵机堵转是最危险的情况之一。堵转时电机通电但不转所有电能都转化为热量。HTD-45H的堵转电流约3A堵转时功率约33W11.1V x 3A。我们实测堵转10秒后舵机外壳温度从室温升到60°C20秒后超过80°C。我们的保护策略是双重阈值电流3A是瞬态保护堵转几秒内触发将舵机目标位置设为当前位置让它停止运动温度70°C是累积保护长期高负载触发所有舵机归到中位「躺平」降温。在实际代码中我们并没有实时监控这些值。因为读位置指令会阻塞舵机约80-100ms我们在平衡控制循环之外单独开一个线程做低频巡检每5秒读一次。堵转保护的核心代码逻辑简化版ifservo.current3000:# mAservo.targetservo.current_position# 停止运动log_warning(Servo %d stalled!%servo.id)ifservo.temperature70:forsinall_servos:s.target500# 归中位log_error(Overheat! All servos to neutral.)7.2.3 重力补偿各关节的负载分析不同姿态下各关节承受的负载差异巨大。站立时受力最大的关节是髋关节前后hip_pitch承受整个上半身的重量力臂是躯干高度电流约1.2A。膝关节knee在腿伸直时力臂短电流约0.8A一旦膝盖弯曲力臂变长电流会迅速上升到1.5A以上。踝关节前后ankle_pitch受力最小约0.3A但精度要求最高。最危险的情况是机器人后仰——身体向后倒髋关节要往前拉才能恢复。但髋关节本身已经承受了大部分体重再加上紧急恢复的力矩很容易超过额定扭矩。这也是为什么我们在ZMP控制器里限制了最大踝关节角度12°和最大躯干倾斜角。关节静态站立电流走路峰值电流堵转风险说明髋关节前后 (hip_pitch)1.2A2.5A高承受上半身重量力臂最长膝关节 (knee)0.8A1.8A中弯曲时力臂变长负载激增踝关节前后 (ankle_pitch)0.3A0.8A低受力小但精度要求高髋关节侧向 (hip_roll)0.5A1.2A中侧向平衡时负载增加踝关节侧向 (ankle_roll)0.4A0.9A低侧向调整负载较小腰部 (torso)0.6A1.0A低后仰补偿时负载增加7.2.4 髋关节保护策略既然髋关节是最容易堵转的关节我们专门做了四层保护第一层——角度限制髋关节前后方向最大运动范围±30°第二层——速度限制髋关节角速度限制在200°/s比其它关节的316°/s更保守第三层——恢复跨步倾斜超过阈值时不硬拉而是迈一步用重力恢复平衡第四层——紧急停机如果以上三层都失效了检测到髋关节电流超过3A持续2秒以上立即停止所有舵机指令让机器人自然倒下。摔坏3D打印结构件只要几块钱电机坏了118块很容易算清楚。7.3 舵机通信的可靠性串口总线舵机最大的优势是接线简单但最大的劣势是通信可靠性。一根线串起21个舵机任何一个节点出问题都可能影响整条总线。7.3.1 校验和不是万能的每条指令末尾都有一个校验和字节算法是取反求和。校验和只能检测到「数据变了」不能纠正。理论上通信错误导致校验和「恰好正确」的概率是1/256约0.4%。在实际使用中出错的常见原因电磁干扰舵机大电流启停时产生电磁干扰如果信号线和电源线绑在一起走干扰会耦合到信号线上偶尔导致位错误长线缆从嵌入式主板到脚踝舵机约80cmTTL电平3.3V在长线缆上衰减严重接插件松动PH2.0接插件反复插拔后接触电阻增大导致信号质量下降。7.3.2 没有ACK机制指令丢了怎么办串口总线舵机协议有一个致命缺陷没有ACK确认机制。你发一条指令舵机不回确认。你不知道它收到了没有也不知道它执行了没有。那在100Hz的控制循环中指令丢了怎么办答案是不做特殊处理靠高频发送来覆盖。因为100Hz意味着每10ms发一次指令如果某条指令丢了10ms后下一条指令到达舵机继续运动。对于平衡控制来说10ms的延迟是可接受的。所以问题的关键不是「指令丢了怎么办」而是「如何保证丢帧率足够低」。这也是为什么乐宝机器人便宜的地方但是随之而来的就是可靠性会低不过对于我们用来验证整体框架逻辑也够了。7.3.3 串口错误处理UART通信有几种常见的错误类型帧错误Framing Error由波特率不匹配或信号质量差导致舵机端检测到后会丢弃当前帧等待下一个帧头溢出错误Overrun Error发生在接收缓冲区满时我们不在100Hz循环中回读数据只在低频巡检时才读奇偶校验错误Parity Error我们没开奇偶校验所以不存在这个问题。在python-pyserial中可以通过设置超时和错误回调来处理这些异常。但在我们的buslinker控制器中由于性能要求我们选择了最简单的方案不检测错误依赖高频发送和校验和来覆盖。7.3.4 100Hz下的丢帧率实测我专门做过一次测试用逻辑分析仪抓取总线波形统计发送的指令数和舵机实际执行的指令数。在正常运行条件下无外部干扰、线缆长度50cm、接插件牢固发送指令10000条舵机执行9991条丢帧9条丢帧率0.09%。这个0.09%的丢帧率在平衡控制中基本没有影响。但如果你发现丢帧率明显高于0.5%就需要排查了检查接插件是否松动最常见原因缩短线缆长度检查电源是否干净舵机电源加滤波电容1000uF电解电容并联0.1uF陶瓷电容不要降低波特率降低波特率只会让问题更糟因为每帧传输时间变长更容易被干扰。7.4 舵机寿命与维护舵机是消耗品。不管你多爱惜它总会磨损。关键是了解磨损的规律提前做好维护方案。7.4.1 金属齿轮的磨损HTD-45H用的是全金属齿轮铜齿轮钢齿轮。我们使用的3个月后拆开检查了负载最重的髋关节舵机。发现齿轮间隙从出厂时的约0.05mm增加到约0.15mm。这个间隙变化导致两个后果位置精度下降空行程从0.2°增加到约0.6°对平衡控制有影响回差导致控制振荡在PD控制中舵机在齿轮间隙区间来回摆动无法精确停在目标位置表现为微小的「嗡嗡」振动。齿轮磨损的速度取决于负载。髋关节磨损最快踝关节磨损最慢。我们建议每3个月更换一次髋关节舵机每6个月更换一次膝关节舵机踝关节和手臂舵机可以撑到一年。顺便说一下舵机的螺丝安装孔也会因为经常运动或者关节来回拆装导致螺丝孔会变大或者安装的时候直接螺丝顶歪了把孔给撑大了。7.4.2 舵机更换快速替换流程换一个舵机听起来简单但如果你不按流程来可能会引发连锁问题。正确流程断电。别带电操作——串口总线上的舵机带电插拔可能会损坏通信芯片。拆下旧舵机记下它的ID。把新舵机单独接上串口主板用厂家自带的软件改ID为旧舵机的ID。把新舵机装到机器人上通电测试。确认方向。用guanjieceshi工具确认方向如果方向反了在代码中翻转不要改舵机硬件。运行关节标定第8章会详细讲确认新舵机的零位和运动范围。最常见的一个错误是新舵机忘了改ID直接插上总线。如果新舵机出厂ID1而整个系统没有ID1的舵机然后就是这个关节永远不动。另一个容易忽略的点新舵机的机械安装角度可能和旧舵机有差异。即使ID和方向一致同样的目标角度下新舵机的实际位置可能偏了1-2°。必须重新标定这个一般厂家的软件会有标定的功能这里就跳过了。7.4.3 舵机故障的常见症状根据我们的使用经验舵机故障通常有以下几种表现抖动 舵机在目标位置附近来回摆动无法稳定。通常是齿轮磨损导致间隙过大或是电位器接触不良。齿轮是焊接在舵机内部的无法单独更换只能换舵机。异响 舵机运动时发出「咔咔」声或刺耳的啸叫声。可能是齿轮有异物、轴承缺油、或者齿轮齿崩了。先尝试加润滑脂如果无效则换舵机。但是一般可以听得出来是机械故障还是操作故障如果是后者通常还是在程序上找找问题。不响应 舵机完全不运动。首先检查供电和信号线如果供电正常用厂商的软件发指令看是否有响应。如果完全没有响应可能是通信芯片烧了通常是因为带电插拔。位置漂移 舵机在不受控的情况下自己慢慢转动。这是最诡异的问题——你发指令让它停在120°它自己慢慢转到了125°。原因是电位器老化输出信号漂移MCU以为「当前位置」变了于是驱动电机去纠正。解决方法是换舵机电位器无法维修。故障症状可能原因严重程度处理方法抖动齿轮磨损/电位器故障中换舵机异响咔咔齿轮异物/缺油中加润滑脂无效则换异响啸叫轴承磨损/齿轮崩齿高换舵机不响应通信芯片烧坏/供电问题高检查供电换舵机位置漂移电位器老化高换舵机温度过高堵转/长时间高负载高检查机械限位增加散热7.5 避坑清单避坑清单 1. move_time不要设0ms——舵机会像打了鸡血一样抖动甚至啸叫。正确做法是设为控制周期减2ms100Hz下用8ms。 说明0ms让舵机以最大功率加速急停惯性导致机械振荡。 2. move_time不要超过控制周期——舵机永远追不上目标位置控制效果大打折扣。 说明滞后会让控制器以为舵机到位了实际没有累积误差越来越大。 3. 不要忽略舵机的速度限制——HTD-45H负载下最大316°/s超过这个速度舵机跟不上累积误差导致失衡。 说明316°/s是从空载333°/s经实测反推的负载最大速度。 4. 髋关节是系统瓶颈——站立时承受全身重量走路时负载峰值接近额定扭矩90%。必须加多层次保护角度限制、速度限制、恢复跨步、紧急停机。 说明摔坏3D打印结构件只要几块钱电机坏了118块很容易算清楚。 5. 堵转保护不能只靠温度——温度上升有延迟等检测到70°C时舵机可能已经烧了。必须同时监控电流3A阈值。 说明双重阈值——电流3A是瞬态保护温度70°C是累积保护。 6. 不要在100Hz循环中读舵机位置——读位置会阻塞舵机80-100ms控制频率骤降到10Hz。开独立线程做低频巡检每5秒一次。 说明这是第6章「只写不读」原则的延伸。 7. 接插件松动是通信故障的元凶——PH2.0接插件反复插拔后接触电阻增大导致信号质量下降。建议定期检查必要时更换。 说明我们遇到过最诡异的问题机器人自己会动查了一整天发现是接插件接触不良。 8. 信号线不要和电源线绑在一起走——舵机大电流启停时产生的电磁干扰会耦合到信号线上。信号线和电源线至少间隔5cm。 说明电磁干扰会让串口信号产生50-100mV噪声偶尔导致位错误。 9. 换舵机必须断电——带电插拔会烧通信芯片。换完后必须重新标定ID、方向、零位、运动范围。 说明新舵机出厂ID默认1不先改ID直接插上总线这个关节永远不动。 10. 齿轮磨损是不可避免的——每3个月更换髋关节舵机每6个月更换膝关节舵机。螺丝孔也会被撑大预留备件预算。 说明舵机是消耗品提前买好备件别等坏了再买。