1.位置控制2.速度控制3.力矩控制4.轨迹规划5.插补控制6.PID控制7.伺服控制8.编码器反馈9.运动学正解10.运动学逆解11.动力学建模12.模型预测控制MPC13.轨迹跟踪14.避障控制15.协作控制16.力控柔顺控制17.位置闭环18.速度闭环19.关节限位控制20.运动平滑控制分两大部分第一部分独立拆解用第一性原理数学物理本质逐一击破这20个概念“它是谁从哪里来到哪里去”。第二部分系统串联按照机器人执行一次精准动作的5个生命周期阶段把这20个技术全部串起来让你明白它们在实战中如何配合作战。第一部分20大核心技术 · 第一性原理拆解按底层逻辑分组第一组目标的“是什么”设定与规划序号技术名称第一性原理数学/物理模型大白话与应用实例4轨迹规划数学在时间域上构造函数 q(t)q(t)满足边界条件起点、终点和约束速度、加速度上限。物理规划出时间-位置-速度-加速度的“S型曲线”或“梯形曲线”。本质决定“怎么走”。实例电梯从1楼到10楼如果直接给最大速度会急冲急停轨迹规划算出一条平滑加速、匀速、减速的“速度曲线”发给电机。5插补控制数学在已知起点和终点的离散点之间按时间步长 ΔtΔt 用线性直线或圆弧圆形算法密化出中间点序列。本质画不出直线那就用无数个微小点“连”成直线。实例写字机器人写“一”字不是直接飞过去而是插补器每1ms算出一个中间坐标点。13轨迹跟踪数学反馈控制实时计算“规划轨迹点”与“当前实际位置”的偏差并驱使它向规划点靠拢。本质“按图施工”不跑偏。实例自动驾驶过弯规划好了路径但风吹偏了车头轨迹跟踪立马修正方向盘。14避障控制数学约束优化或势场法。在目标函数中加入“斥力势能” UrepUrep​。物理上相当于机器人周围有一圈无形的“气垫”。本质遇山绕路。实例扫地机器人碰到桌腿势场斥力让它自动弹开同时吸引力拉着它继续往前走。第二组关节的“怎么转”几何与运动学序号技术名称第一性原理数学/物理模型大白话与应用实例9运动学正解数学三角函数链式变换。已知每个关节角度 θiθi​求末端在三维空间的位置 (x,y,z)(x,y,z)。基于DH参数矩阵连乘。本质已知“胳膊肘怎么弯”问“手指尖在哪”。实例示教器上显示当前角度屏幕上的3D模型末端位置实时更新。10运动学逆解数学非线性超越方程求解雅可比矩阵迭代或几何解析法。已知末端位置 (x,y,z)(x,y,z)反求关节角度 θiθi​。本质已知“手指要够到水杯”问“每个关节该弯多少度”。实例六轴机器人焊接时给焊枪一个直线轨迹点逆解实时算出6个轴的角度。第三组力量的“多大劲”动力学与预测序号技术名称第一性原理数学/物理模型大白话与应用实例11动力学建模物理基于牛顿-欧拉方程或拉格朗日方程M(q)q¨C(q,q˙)G(q)τM(q)q¨​C(q,q˙​)G(q)τ。考虑质量、惯性、科氏力、重力。本质算清楚“为了这个加速度电机到底要出多大力”。实例搬运重物时动力学模型算出前馈力矩电机提前发力防止启动瞬间“点头”。12模型预测控制MPC数学滚动时域优化。利用动力学模型预测未来N步的状态求解使代价函数偏差能耗最小的控制序列只执行第一步下一周期重新算。本质“走一步看三步”谋定而后动。实例无人机特技飞行MPC提前预测风阻和惯性在翻跟头时提前给满油门。第四组执行的“精确闭环”伺服与反馈核心序号技术名称第一性原理数学/物理模型大白话与应用实例17位置闭环数学比例(P)反馈。ePositiontarget−PositionactualePositiontarget​−Positionactual​输出速度指令。本质没到目标那就继续走实例数控机床定位差0.01mm就继续补一点。18速度闭环数学比例-积分(PI)反馈。eVelocitytarget−VelocityactualeVelocitytarget​−Velocityactual​输出力矩指令。本质速度慢了就多给点电快了就收点电。实例传送带跟随速度闭环保证转速恒定在300转/分。3力矩控制电流环物理电机电磁转矩方程TKt⋅ITKt​⋅I。控制电流 II 即控制力矩。数学PI调节器。本质最内环直接管电机“吃多少电”。实例机器人撞墙时位置环还没反应过来力矩环先检测到电流飙升堵转立刻限流保护。7伺服控制综合位置环速度环电流环三环级联的统称。本质伺服驱动器就是做这件事的“黑盒子”。实例你买伺服电机插上电调参数就是在调这三环的PID。6PID控制数学u(t)Kpe(t)Ki∫e(t)dtKdde(t)dtu(t)Kp​e(t)Ki​∫e(t)dtKd​dtde(t)​。比例(当前误差)、积分(累计误差)、微分(误差趋势)。本质万金油反馈算法。实例恒温空调就是PID——冷了猛吹热风P一直差一点就累积加力I快到温度了提前减力防止过冲D。1位置控制伺服三环中的最外环。输入目标位置输出速度指令给速度环。本质告诉电机“转到哪个角度停下”。2速度控制伺服三环中的中间环。输入目标速度输出力矩指令给电流环。本质告诉电机“转多快”。8编码器反馈物理光电/磁栅将机械转角转换为数字脉冲。数学脉冲计数 ×× 分辨率 角度。本质机器人的“眼睛”告诉CPU当前到底在哪。实例分辨率17位的编码器转一圈能反馈131072个位置精度达微米级。20运动平滑控制数学低通滤波或S型加速度曲线。限制加加速度 Jerkda/dtJerkda/dt 的突变。本质消除“猛点头”和“顿挫感”。实例高档电梯里的乘客感觉不到启停就是因为做了加加速度限制。第五组安全的“底线”柔顺与限幅序号技术名称第一性原理数学/物理模型大白话与应用实例19关节限位控制数学饱和函数Saturation。当关节角度 θθmaxθθmax​ 时控制量钳制在安全值或触发急停。本质物理硬限位前的“软件安全带”。实例机械臂转到极限角度时控制系统拒绝继续执行并报警。16力控柔顺控制物理阻抗/导纳模型Mde¨Bde˙KdeFextMd​e¨Bd​e˙Kd​eFext​。把机器人模拟成“弹簧-阻尼-质量”系统。本质不是死硬地顶住而是“顺势而为”。实例精密装配轴孔配合卡住了就主动微微偏摆找中心不强行硬怼。15协作控制综合力控 限速 安全监测。本质上是在速度/力矩环上叠加安全监控器限制最大力矩和速度。本质和人一起干活时变成“软柿子”碰人就停或降速。实例协作机器人拖拽示教你拉它它感知到外力F顺着力的方向走。第二部分实战阶段串联——5个阶段覆盖全部20个技术假设任务一个6轴机器人要把一个易碎玻璃杯从A点拿起绕过中间一根柱子精准放到B点且过程中不能有任何冲击。阶段一远程规划大脑皮层—— 谋略阶段运用技术4. 轨迹规划14. 避障控制15. 协作控制设定安全模式发生了什么CPU根据A点和B点调用全局路径规划器。通过势场法避障规划出一条绕过柱子的几何路径。然后给这条路径赋予时间属性S型速度规划确保加速度不会太大弄碎杯子。小白理解高德地图帮你选了一条不堵车避障的路并且告诉你限速多少轨迹规划。阶段二关节拆解小脑几何计算—— 换算阶段运用技术10. 运动学逆解9. 运动学正解验证发生了什么CPU拿到规划好的末端坐标点序列比如1000个点。它调用逆解算法把每个末端坐标 (x,y,z)(x,y,z) 实时换算成6个关节的角度 (θ1...θ6)(θ1​...θ6​)。同时用正解校验一下防止算出来的角度导致姿态翻转。小白理解导航告诉你“直走100米”你的大脑把它换算成“左腿迈3步右腿迈3步”逆解。阶段三力量预判高阶大脑—— 前馈阶段运用技术11. 动力学建模12. 模型预测控制MPC发生了什么系统知道下一个点需要多大的加速度。利用动力学模型计算出克服重力和惯性需要的前馈力矩 τffτff​。MPC则进一步推演未来5个点的状态提前微调力矩防止末端在转弯处因为惯性跑偏。小白理解你端着满满一杯水转弯你会提前侧身倾斜前馈防止水洒出来而不是等到水洒了再修正反馈。阶段四实时伺服执行脊髓与肌肉—— 精调阶段最核心嵌套了闭环运用技术5. 插补→17. 位置闭环 / 18. 速度闭环 / 1. 位置控制 / 2. 速度控制→6. PID控制→7. 伺服控制内部集成3.力矩控制同时8. 编码器反馈实时回传20. 运动平滑控制嵌入在指令生成端。发生了什么层层嵌套插补(5)每1ms插补器在规划轨迹上算出一个目标位置极细密的小点。平滑(20)把这个目标位置先经过一个低通滤波器抹掉微小的毛刺。位置环(17 1)比较“目标位置”和“编码器(8)反馈的位置”偏差 ee 送入位置环PID输出目标速度。速度环(18 2)比较“目标速度”和“编码器微分反馈的速度”偏差送入速度环PID输出目标力矩电流。电流环(3 7)比较“目标电流”和“驱动器实际电流”输出PWM波给IGBT开关管。伺服驱动(7)带着电机转动编码器(8)实时把角度传回来形成完整的负反馈闭环。小白理解就像你用眼睛盯着画笔位置环手觉得画快了速度环就少用点劲电流环每一笔画完都看看偏没偏。阶段五安全保障反射弧—— 边界守护运用技术19. 关节限位控制16. 力控柔顺控制发生了什么在运动中关节限位(19)实时监控6个轴的角度一旦某个轴接近机械极限立刻插队给速度环发“减速停止”指令。如果在放置杯子时卡住了电机电流异常飙升力矩环检测到力控柔顺(16)立刻介入切换成导纳控制让机器人往受力小的方向退缩几毫米找到孔位滑进去然后恢复位置闭环。小白理解看到前面有墙限位腿自动刹车手摸到烫水壶肌肉自动弹开柔顺不用过脑子。第三部分给新手的实战避坑建议调试顺序铁律先内环后外环。刚拿到机器人/电机千万别先调位置环必须先把电流环力矩环调稳电机不啸叫再调速度环转速平稳无抖动最后才调位置环。否则外环一震荡内环直接烧驱动器和电机。PID调参的“生死三秒”先给个极小的P比例让系统动起来。如果系统一直震荡来回晃立刻把 D微分加大阻尼作用。如果系统永远差几微米到不了目标加入极小的 I积分消除静差。切记积分在运动过程中尽量关闭只在停止定位时打开否则运动过程会严重过冲轨迹规划是“爹”PID是“儿子”很多新手死磕PID却不知如果轨迹规划S曲线生成的加速度是突变的再好的PID都跟不上。工作中80%的抖动问题出在轨迹不平滑只有20%是PID没调好。先检查加加速度Jerk是否设得太离谱。必须搞懂“前馈”与“反馈”的区别反馈PID是“出了错再改”永远有滞后。前馈动力学模型是“还没出错就提前预防”。工作中高速重载场景如搬运大工件必须加上重力补偿前馈否则加减速瞬间位置环来不及反应轨迹会严重偏离。编码器分辨率不是越高越好分辨率太高如23位反馈数据量巨大导致通讯周期变长控制频率上不去。工程原则控制周期如1kHz下编码器分辨率只要能保证位置环量化误差小于定位精度的1/5即可。最后一句心法机器人运动控制的本质就是“在数学空间里算准何时转、在物理世界里感知用了多大力、在时间维度上通过闭环不断修正偏差”。工作中遇到任何问题就照着这个思维去排查——先看规划几何再看反馈传感器最后看参数PID。山一程水一程身向榆关那畔行夜深千帐灯。——纳兰性德《长相思·山一程》