机器人钻进窄空间就撞?先查轨迹规划,别怪机器人精度

一条 CNC 立式加工中心的上下料线,6 轴机器人从一扇高 0.5 米、宽 0.6 米的安全门开口探进去 0.9 米取放工件。最窄的地方,夹爪本体离门楣只有 35 到 50 毫米。投产两个月,机器人撞了 9 次:7 次蹭掉工件边角,2 次卡死要人工复位,每次复位重教 0.5 到 1 小时,累计停机 5 到 8 小时。蹭伤的 12 件当废品,单件 380 元,加上停机损失,两个月赔了 6 到 8 万。现场第一反应都是机器人重复定位精度飘了,或者夹具装歪了。后来把路径一帧帧拉出来看,根子不在精度,在轨迹规划。

先把话说明白:窄空间撞机,根子在轨迹规划不在机器人精度

• 窄空间里撞机,九成不是机器人精度差,是运动指令类型和路径没考虑真实臂展:默认关节插补会把拐角切进障碍,看着顺实际偏。
• 窄口正对着腕部奇异点,解算器在那一帧轴速飙升、构型翻转,末端 TCP 直接甩出规划线。
• 仿真只算了 TCP 一个点,夹爪本体、线缆、法兰盘根本没进碰撞模型,实际安全走廊比建模窄了 100 毫米以上。
• 验收得先把速度压到 30 个百分点过窄段止损,再用直线运动加碰撞模型重排路径,在 30、60、100 个百分点速度各跑无碰才算过关。

几个绕不开的定义

轨迹规划(Trajectory Planning) 是给定起点和终点后,计算机器人各轴随时间的位置、速度和加速度,决定它怎么走过去。它分关节空间和笛卡尔空间两种,走法差很多。

关节插补(MoveJ / Joint Interpolation) 是只规定起点和终点的各轴角度,中间怎么拐由控制器按最短关节路径自己补,路径圆滑的同时会鼓出你画的折线走廊。

奇异点(Singularity) 是机器人某个构型下雅可比矩阵退化,末端一点微小位移需要某轴极高速度才能跟上,常见于腕部伸直、肘部完全展平的姿态。

碰撞检测(Collision Detection) 是给机器人臂、夹具、环境各建一个简化包围体,在线上或实时算它们是否干涉,有干涉就停或者绕开。

为什么路径看着顺,实际还撞

关节插补把拐角切进了障碍里

示教时你在两个点之间点了移动,默认是关节插补。控制器为省时间走最短关节路径,这条曲线在窄口那段会鼓出你画的折线走廊。我们量过,门楣那段最多鼓出 40 毫米,正好压在 35 到 50 毫米的间隙上。示教器里路径看着顺,是因为它显示的是关节路径投影,不是真实臂体包络,拐角鼓出去那一段在屏幕上根本看不出来。

窄口正对着腕部奇异点,解算一翻就偏了

机器人伸进 0.9 米深的开口时,腕部接近伸直,落进腕奇异区。那一帧,控制器为了让末端点跟上指令,4 轴或 6 轴速度瞬间拉高,构型在两种解之间翻转,末端 TCP 一下甩出规划线十几毫米。这种偏移是瞬时的,示教慢放看不出,只有全速循环时才暴露。常见误解:以为是机器人重复定位精度差。精度是稳态指标,奇异点是瞬态失控,两码事,拿精度去解释撞机只会越调越偏。

仿真只算了 TCP 一个球,夹爪本体根本没建模

离线仿真里,工程师常只给末端 TCP 放一个半径球做干涉检查。可实际伸进窄口的是夹爪本体加一段线缆,比 TCP 球大一圈。我们的夹爪从法兰伸出 120 毫米,加上线缆 bundle,真实包络比仿真球多占 100 到 130 毫米。仿真说走廊够,是因为它根本没算这部分。还有一种坑:工具数据 DHF 没填重心和延伸长度,仿真按默认零长度工具算,误差更大,过了也白过。

几条路,按性价比排好

常见问题

问:示教器里看着不碰,为什么实际碰了?

答:示教器显示的是关节路径投影,不是真实臂体包络;而且默认运动指令是关节插补,拐角会鼓出走廊。再加上夹爪本体没建模,看着顺的实际偏出去几十毫米。要把运动指令改成直线,并把夹爪包络加进碰撞模型再看一遍。

问:MoveJ 和 MoveL 到底怎么选?

答:凡是要穿过窄通道、贴近障碍的段落,一律用直线运动 MoveL 或圆弧 MoveC,保证末端走你画的线。关节插补 MoveJ 只适合空旷处的大范围转移。窄口那段用 MoveJ,等于主动让路径鼓进障碍,撞机头号原因就是它。

问:奇异点一定要避开吗,绕一下不就行了?

答:腕部或肘部奇异点附近,轴速会飙升、构型会翻转,末端瞬时偏出十几毫米,窄口里这就是撞。不能硬穿,要把站位或工具姿态调开,让窄段落在远离奇异的构型。实在调不开,就上姿态冗余避奇异算法。

问:仿真都过了还撞,问题出在哪?

答:九成是仿真保真度不够:只建了 TCP 球没建夹爪本体和线缆,工具数据没填重心延伸,或者环境模型比现场小一圈。仿真要用和实际一致的 DHF 和完整包络,否则过了也白过。

问:已经撞了几次,是先降速还是先改路径?

答:先降速止损。窄段速度压到 30 个百分点以内,把损失先控住;同时改直线运动、补碰撞模型、避开奇异点,这才是根治。只降速不改进,节拍和隐患都还在,下次还会撞。

落地的坑,验收时没人会主动告诉你

• 先降速:窄段速度压到 30 个百分点以内先止损,再谈改路径,别硬扛全速循环。
• 确认运动指令类型:所有贴近障碍的段落用 MoveL/MoveC,绝不用关节插补,这是撞机的头号原因。
• 把夹爪本体、法兰盘、线缆 bundle 全进碰撞包围盒,别只用 TCP 一个球,真实包络比球多占 100 毫米以上。
• 标出窄段附近的奇异区,重排站位或工具 Z 偏移避开,调不开就上避奇异算法。
• 离线仿真用和实际一致的 DHF,填重心和延伸长度,模型比现场小一圈等于没仿真。
• 加实时碰撞监控:安全 PLC 监控各轴扭矩或包围盒干涉,有干涉先停,比撞了再修便宜得多。
• 验收在 30、60、100 个百分点速度各跑 50 周期无碰才算过关,别只在额定速度验证一遍。
• 补偿不是根治:降速和软限位是止损,碰撞模型加路径重排才是长治久安,定期复校 DHF 才有保障。