★ FEATURED ARTICLE 简介16舵机双足机器人是一份融合机械结构、驱动电路与嵌入式控制的综合工程资料适合机器人爱好者、电子工程师及高校相关专业学生用于学习多舵机协调控制和双足步态设计。压缩包共147个文件、约3.72MB其中49个PCB与44个SCH文件为主覆盖电路板布局与原理图设计另含C/H源码、PDF手册及仿真文档便于从硬件到程序完整还原项目工程文件组织结构清晰可按电路、源码、文档分模块查阅。该资料目前已有488人学习。内容对舵机PWM控制、多通道驱动电路设计、微控制器编程及NRF24L01无线遥控等关键环节均有展开并附有步态算法与动作序列代码可直接移植或二次开发。通过研读PCB/SCH可理解电源分配与保护电路结合C源码可快速掌握16路舵机独立控制逻辑与无线收发调试思路适合课程设计、毕业设计及从零搭建具备远程操控能力的双足机器人平台。1. 16舵机双足机器人从“能抬腿”到“能立住”到底卡在哪16舵机双足机器人听起来就是给机器人装上16个舵机凑出两条腿可真实情况是一抬腿就摔。我第一次给一台16舵机双足机器人做上电测试左脚刚离地2厘米整台机器直接朝右侧栽倒查到最后根本不是舵机没力而是重心还停在两脚中间支撑脚压根没吃上力。这份资源就是围绕16舵机双足机器人这套硬件配置展开的完整落地笔记覆盖自由度分配、舵机选型与供电、步态状态机、逆运动学解算和调参顺序。适合买过双足套件却始终走不稳的新手也适合做课程设计或机器人竞赛但不想从零踩坑的老手。思路清楚了再动手比盲目烧录要省两个晚上的调试时间。2. 硬件架构16路舵机怎么分配自由度选型和供电的血泪经验2.1 自由度分配为什么是双腿12路、上身4路双足机器人要稳定行走腿部的自由度分配几乎决定了后续所有控制算法的复杂度。16舵机方案最常见的做法是双腿各6个自由度剩余4个自由度给上肢或头部。这看起来是普通的计数问题但每个自由度负责的动作完全不同选错了关节类型后面写步态的时候会非常别扭。我拆过的方案里髋关节占2个自由度侧摆roll负责左右方向的重心补偿前摆pitch负责前后方向的迈腿动作。膝关节占1个自由度只有前摆弯曲角度决定抬腿高度。踝关节占2个自由度前摆控制脚掌俯仰侧摆控制脚掌左右水平。这样单腿共5个自由度但髋关节还需要额外的偏航自由度yaw来让脚尖朝外或朝内所以单腿按6个自由度配齐两条腿就是12路舵机。剩余4路舵机通常给头部偏航与俯仰各1个左右手臂各1个。如果要减配先把手臂去掉头部保留偏航用于视觉巡线时转向。千万不要砍踝关节的侧摆自由度那是维持左右平衡的关键砍掉之后单脚支撑阶段就只能靠髋关节硬扛步态参数稍微大一点就翻车。部位关节自由度作用髋前摆 pitch2迈腿前后摆动驱动步幅髋侧摆 roll2重心左右偏移髋偏航 yaw2脚尖朝向调整膝前摆 pitch2抬腿高度控制踝前摆 pitch2脚掌俯仰维持躯干水平踝侧摆 roll2左右地面贴合头偏航俯仰2传感器视角调整手臂前摆2姿态抵消视觉平衡2.2 舵机扭矩估算别信标称力矩动载系数要留足很多人选舵机只看“标称多少公斤”然后整机装好后发现抬腿时舵机吱吱叫甚至直接堵转。以我调过的本机重量约1.5kg为例单脚支撑时髋关节需要承受整机重量如果重心到髋关节的水平距离约5cm静扭矩约为1.5乘以9.8乘以0.05约合7.5公斤·厘米。但步行时重心不是静态的身体前倾、落地冲击都会让实际力矩瞬间翻倍所以动载系数至少要留2.5到3倍髋关节舵机选20公斤·厘米级别才稳。这里有个容易被忽略的点踝关节同样不能减配。脚掌着地时踝关节要维持躯干水平落地冲击产生的反作用力直接作用在踝关节上选型和髋关节一样用同一级别。全机统一舵机型号还能减少备件压力坏了任意一个位置都能直接替换不用区分大小舵机。供电方面更要提前算账。16个舵机同时动作时瞬时电流可能冲到10安培以上USB供电或者普通的5V稳压模块一拉就崩。我一般用2S锂电作为总电源再通过一路输出能力在10A以上的 BEC 给舵机供电。这是个典型的“看起来电压够了实际电流不够”的坑后续避坑章节会再展开。2.3 供电与配重掉电压比缺扭矩更容易翻车供电问题的表现往往是“机器人走着走着开始抽搐”不是舵机坏了是瞬间压降导致舵机内部逻辑复位。PWM舵机对电压波动特别敏感跌到4.8V以下就可能出现不受控抖动。解决思路分两条线硬件上在舵机电源总线并联大容量电解电容软件上让舵机动作错峰。配重的位置也很有讲究。电池尽量放在骨盆高度附近也就是髋关节横轴的位置。把电池背在胸口虽然换电池方便但重心明显上移机器人走路时身体像喝醉一样左右晃。重心低转动惯量小步态控制时才会觉得机器人“听话”。结构件方面3D打印PLA只能用低填充率做原型验证长期行走建议用PETG或者碳纤维管作为腿部主要受力件。舵机臂固定螺丝一定要打低强度螺纹胶这个属于高频振动环境下的基本操作不加的话走着走着螺丝松了角度全偏。注意扭矩计算用的1.5kg是整机重量如果你加了机械手臂或者大电池按实际重量重新算一遍不要照抄。3. 步态控制从重心偏移到静步态让代码告诉舵机怎么走3.1 双足步态的基本逻辑先移重心再抬腿双足行走的底层逻辑其实是一个平衡问题重心在地面上的投影必须落在支撑多边形内。双脚着地时支撑多边形是两只脚加上中间区域抬脚之后支撑多边形立刻缩成单脚脚掌那一小块。所以代码里最核心的一步不是“抬腿”而是“把重心先挪到支撑脚上方”。静步态控制适合16舵机这种没有力反馈关节的配置。整个步态周期拆成5个阶段重心偏移、抬腿、摆腿、落腿、重心回中。每个阶段只驱动部分舵机动作等机械到位之后才进入下一个阶段。千万不要用连续的Sin曲线去扫髋关节角度那样看着连续实际上舵机响应速度跟不上轨迹会严重变形。重心偏移是通过控制支撑腿一侧的髋关节侧摆角度来实现的。以向左迈步为例先把髋关节整体向右侧移大约25到35毫米感觉就是身体向右倾斜此时重心投影落在右脚脚掌内然后抬起左脚完成摆腿落地再把重心移回两脚中间。整个过程里躯干始终保持接近水平这是踝关节前摆舵机在持续修正的结果。3.2 步态状态机C语言的实现我比较习惯用状态机来管理步态阶段。每个状态对应一组舵机角度目标状态切换时先检查“是否所有舵机已经到达目标”确认后再进入下一阶段。这里给一个精简的状态机代码片段// 步态阶段定义 typedef enum { PHASE_SHIFT, // 阶段1: 重心偏移 PHASE_LIFT, // 阶段2: 抬腿 PHASE_SWING, // 阶段3: 摆腿 PHASE_LAND, // 阶段4: 落腿 PHASE_RETURN // 阶段5: 重心回中 } GaitPhase; // 步态参数结构体 typedef struct { int shift_xy; // 重心偏移量单位mm int lift_h; // 抬腿高度单位mm int stride; // 步长单位mm int phase_time; // 每个阶段的等待时间ms } GaitParam; GaitParam gp {35, 20, 25, 400}; // 阶段切换函数: 返回当前阶段 int gait_run(int step) { switch (step) { case PHASE_SHIFT: // 控制髋侧摆让身体重心移到支撑脚上方 hip_roll_cmd(LEFT, -gp.shift_xy); hip_roll_cmd(RIGHT, -gp.shift_xy); break; case PHASE_LIFT: // 抬腿: 膝关节弯曲踝关节收缩 knee_pitch_cmd(SWING_LEG, gp.lift_h); ankle_pitch_cmd(SWING_LEG, -gp.lift_h * 0.3); break; case PHASE_SWING: // 摆腿: 髋关节前摆步长由髋pitch决定 hip_pitch_cmd(SWING_LEG, gp.stride); break; case PHASE_LAND: // 落腿: 膝关节伸直踝关节回平 knee_pitch_cmd(SWING_LEG, 0); ankle_pitch_cmd(SWING_LEG, 0); break; case PHASE_RETURN: // 重心回中 hip_roll_cmd(LEFT, 0); hip_roll_cmd(RIGHT, 0); break; } return 0; }代码里的shift_xy、lift_h、stride三个参数是整个步态调试的核心变量。重心偏移量如果太小抬腿时重心投影靠近脚掌边缘机器人会往侧面倒太大则机器人姿态倾斜支撑腿舵机负载飙升。抬腿高度也不是越高越好20毫米左右足够避开地面轻微不平太高会让重心在竖直方向上大幅波动。等待时间这里用了400毫秒具体数值要看舵机实际速度带载后动作变慢等待时间要适当加长到500到600毫秒。3.3 动作同步与死区补偿细节决定站不站得稳状态机写好了但实际运行时还有两个细节必须处理。第一是舵机动作的错峰。16路舵机如果同时输出角度指令电源瞬间被拉出一个很大的低谷此时如果相邻舵机还在保持扭矩就会出现整体抖动。所以每一帧里我通常只更新4到6个舵机的目标角度其余舵机保持原角度输出让电流曲线平缓一些。第二是舵机死区。数字舵机都有死区指令角度和目标角度差值小于一定范围时舵机不会动作。状态机里如果频繁微调0.5度、1度舵机根本不动机械结构却已经到位此时查代码会觉得“明明发了指令怎么没反应”。我一般设定最小角度差为3度小于这个值就拉一个“舵机到位”的判断避免无意义等待。4. 逆运动学与关键参数几何法解算腿部位置4.1 为什么需要逆运动学不用预设角度表预设角度表的做法是给每个步态阶段直接写死具体角度比如“髋关节30度膝关节40度”但这样每次调整步长或者抬腿高度整张表全部要重改。逆运动学的思路是把脚踝相对髋关节的位置作为输入让程序算出髋、膝、踝三个关节的角度步长和抬腿高度都变成坐标变化改参数只改坐标角度由算法自动解算。我用的几何解法建立在腿部简化模型上大腿长度a小腿长度b髋关节到踝关节连线的长度由目标位置决定。这个三角形在腿部平面内直接求解不需要复杂的矩阵运算16位单片机也能实时算出来。具体坐标系定义为髋关节中心为原点x轴朝前z轴向下。输入目标坐标(dx, dz) 是指踝关节相对髋关节的位置。股骨长a和小腿长b分别是腿部连杆长度单位毫米。程序需要输出的角度为髋关节角、膝关节角和踝关节角。4.2 几何解算Python参考实现这里给一个Python版本的参考实现逻辑和单片机上的C版完全一致import math def leg_ik(dx, dz, thigh45.0, shank45.0): 输入: 踝关节相对髋关节的位置 dx(前向), dz(向下) 输出: hip_angle(髋), knee_angle(膝), ankle_angle(踝) 单位: 输入mm, 输出角度(度) # 计算髋到踝的直线距离 dist math.sqrt(dx*dx dz*dz) # 可达域校验: 腿部伸直时距离最大 max_reach thigh shank if dist max_reach: print(目标超出可达范围, 距离:, dist, 最大:, max_reach) return None if dist abs(thigh - shank): print(目标距离过近, 腿部无法弯曲到该位置) return None # 余弦定理求膝关节角度(弯曲角) cos_knee (thigh*thigh shank*shank - dist*dist) / (2 * thigh * shank) knee_bend math.acos(max(-1.0, min(1.0, cos_knee))) * 180.0 / math.pi # 求髋关节角度: 腿杆方向角 三角形内角 leg_dir math.atan2(dx, dz) * 180.0 / math.pi cos_hip (thigh*thigh dist*dist - shank*shank) / (2 * thigh * dist) hip_offset math.acos(max(-1.0, min(1.0, cos_hip))) * 180.0 / math.pi hip_angle leg_dir - hip_offset # 踝关节角度: 让脚掌保持水平 ankle_angle -(hip_angle knee_bend) return hip_angle, knee_bend, ankle_angle代码里最关键的是可达域校验。如果输入的dx、dz让dist大于大腿加小腿的长度比如90毫米几何上根本够不到此时直接返回错误比输出一个NaN角度要安全得多舵机不会因为非法角度卡到极限位置。另外math.atan2(dx, dz)用了双参数反正切x为零时也不会除零报错。大腿和小腿长度根据实际结构件尺寸填写我这边用的是各45毫米如果你改了连杆长度参数表同步改掉。这个函数输出的角度是基于几何关系的理论值。实际装调时舵机安装方向不同角度可能要做反向或偏移映射我在使用时会加一个角度偏置表把计算角度和实际安装角度对齐。4.3 关键参数地图每个参数对应什么“手感”参数常见范围调大后果调小后果重心偏移量25-40mm幅度大重心超出脚掌边界抬腿时向侧面倾倒抬腿高度15-30mm重心竖直波动大、落地冲击大容易绊到地面障碍物步长20-35mm重心前移不够身体前倒行走速度太慢阶段等待时间400-600ms走一步要一秒以上动作卡顿舵机未到位直接切换姿态突变这四个参数是联动的不是孤立调整。步长加大重心偏移也要跟着加大否则迈出的腿带不动身体。等待时间缩短落地冲击变大需要用踝关节缓冲。我一般把参数表做成全局变量方便在串口调试时直接修改这个习惯会在最后一章展开说。5. 避坑与排查供电、抖动、重心、通信四大翻车现场5.1 一模一样的指令走几步就抽搐是舵机坏了还是供电崩了现象机器人能正常走几步然后某个腿的舵机开始“咔咔”抖动像一直被卡住又一直在反抗。停下程序后抖动停止重新上电又正常。原因舵机瞬间电流需求超过供电模块的带载能力电压被拉低到欠压阈值舵机内部逻辑开始复位。16路舵机在步态相位切换的瞬间会同时启动峰值电流可能超过BEC额定电流的数倍。解决先看供电模块的峰值输出能力至少10A以上再在舵机电源总线上并联两个3300微法电解电容吸收瞬态峰值。软件层面做错峰把同一帧的16路角度更新拆成4批每批间隔10毫秒。用示波器或万用表量舵机电源端的电压如果低于5V说明BEC的动态响应跟不上换更大电流的模块。5.2 抬腿瞬间直接摔倒调大扭矩也没用现象程序设定先抬左脚但左脚刚离地机器人就朝右侧倒下去试了很多次都这样换更大扭矩舵机也没解决。原因重心没有先偏移到右脚上方。抬起左脚之后支撑多边形只剩右脚如果重心仍在两脚中间甚至偏左重力矩会迅速把机器人往右侧拉倒。这属于步态逻辑问题不是力矩问题。解决把步态状态机里的阶段顺序改成先让髋关节侧摆动作让重心投影落到支撑脚脚掌内稳定300毫秒以上再执行抬腿动作。这里有一个可以验证的硬指标重心偏移量要大于等于脚掌宽度的一半减去安全余量比如脚掌宽40毫米偏移量至少25毫米。5.3 PWM舵机走久了位置漂移角度回不到零位现象连续行走两三分钟后机器人的姿态慢慢偏斜一条腿的脚踝角度从0度变成了3度行走轨迹呈弧线。原因PWM舵机没有位置反馈内部电位器的测量存在累积误差加上负载情况下齿轮回差指令角度和实际角度会逐渐偏离。解决不想换总线舵机的话在每个步态周期的“重心回中”阶段强制给所有舵机补发一次零位角度指令持续200毫秒利用舵机的死区特性消除累积误差。如果补发次数多了还是漂移检查舵机齿轮是否磨损特别是髋和踝关节的常载舵机。预算允许就换支持角度回读的总线舵机在代码里实时比对应答角度偏差大于2度时自动补偿。5.4 舵机臂螺丝反复松脱走着走着角度就乱了现象拧紧的舵机臂固定螺丝走一段时间再检查发现已经松动舵机臂能用手轻微晃动。原因舵机输出轴在堵转时会有高频振动普通的十字螺丝在这种振动下会逐渐回退。加上金属舵机臂和舵机盘之间摩擦系数低螺丝一旦松动回差就变大。解决每个舵机输出轴的固定螺丝都要涂低强度螺纹胶不要涂高强度否则后续拆装维护很痛苦。安装舵机臂时先锁定舵机输出轴到零位再套舵机臂避免输出轴在受力状态下锁紧导致齿轮崩齿。结构件与舵机之间的空隙用尼龙垫片补齐不要用螺丝硬拉。6. 最后100米验证清单与在线调参习惯6.1 上电前的验证清单双足机器人的调试顺序必须是线性的跳过任何一步后面走不稳都很难定位是哪个环节出的问题。我固定的验证顺序如下零点校准、静态站立、重心偏移验证、单脚抬腿验证、平地慢走、步速递增。零点校准阶段给所有舵机发90度中位信号拆下舵机臂手动调整到水平位置再装臂。静态站立阶段检查四条腿的脚掌是否完全平贴地面踝关节角度是否归零。重心偏移验证阶段只执行PHASE_SHIFT观察机器人整体倾斜方向是否与预期一致支撑脚掌是否压实。单脚抬腿验证阶段手动抬起非支撑腿看机器人能否保持3秒以上不晃。这一步做扎实之前不要启动连续行走的代码。6.2 串口在线调参不再反复烧录固件我习惯在固件里预留一套可在线修改的步态参数通过串口命令注入调参时不用反复重新编译烧录。思路是把步态参数做成全局变量命令行解析到一个简单的状态机里。用这种方式调步长和重心偏移一次试走的时间从“改代码加烧录加复位”的几分钟压缩到十几秒一个晚上就能从站不稳调到能走三步这是调试效率最大的提升。从那以后我在给任何双足机器人上电之前都会强制走一遍这套验证清单先让它在原地站够半分钟再谈走路的事。希望帮到你。本文还有配套的精品资源点击获取
阅读完成 · 觉得有帮助？
