一、轨迹规划到底在规划什么?
各位同学好,我是老张。在龙门机器人这个行当摸爬滚打了十几年,今天咱们聊聊轨迹规划。
说白了,轨迹规划就是回答三个问题:去哪儿、怎么去、去得多快。你想想看,一个龙门架带着几十公斤的负载,在车间里来回穿梭,如果路径没规划好,轻则抖动、重则撞机。我见过太多新手,一上来就调PID,结果发现根本问题出在轨迹上。
轨迹规划的定义其实很简单:根据任务要求,生成一条从起点到终点的、满足约束条件的运动路径,并给出每个时刻的位置、速度、加速度。嗯,这里要注意,不是随便画条线就行,得考虑电机能不能跟上、结构会不会共振。
核心公式:
q(t) = f(t) // 位置随时间变化
q̇(t) = df/dt // 速度
q̈(t) = d²f/dt² // 加速度
这三个量,就是轨迹规划要输出的全部内容。
二、两大流派:关节空间 vs 笛卡尔空间
做轨迹规划,首先得选坐标系。我个人习惯把这个问题分成两类:
2.1 关节空间规划
什么叫关节空间?就是直接控制每个电机的角度或位移。比如龙门机器人的X轴走多少、Y轴走多少、Z轴走多少。
优点很明显:
- 计算简单,每个轴独立规划
- 不会出现奇异点(这个后面会讲)
- 容易实现高速运动
缺点也致命:
- 末端轨迹不可控——你没法保证工具走直线
- 容易产生不必要的运动
我在项目中遇到过一件事:有次做码垛,用关节空间规划,结果机器人走了一条弧线,差点撞到旁边的料架。从那以后,凡是需要精确定位的场合,我都改用笛卡尔空间。
2.2 笛卡尔空间规划
笛卡尔空间,就是直接在三维空间里规划末端执行器的路径。说白了,你让工具走直线,它就真走直线。
优点:
- 路径直观可控
- 适合焊接、涂胶等需要直线运动的工艺
缺点:
- 计算量大,需要实时逆解
- 可能遇到奇异点——电机突然需要转得飞快
- 速度可能不均匀
我的建议:
如果只是点到点的搬运,用关节空间就够了。如果是连续轨迹(比如弧焊),必须用笛卡尔空间。别问我怎么知道的——当年为了省事用关节空间做焊接,结果焊缝歪歪扭扭,被质检骂了一下午。
三、性能指标:好轨迹的三大标准
怎么判断一条轨迹好不好?我一般看三个指标:
| 指标 | 含义 | 我的经验值 |
|---|---|---|
| 时间 | 从起点到终点花多久 | 越快越好,但别超过电机极限 |
| 平滑度 | 加速度变化率(加加速度) | 加加速度越小,机器人越稳 |
| 能耗 | 电机消耗的能量 | 占整个产线成本的15%-30% |
3.1 时间指标
时间就是金钱。产线上每快0.1秒,一天就能多产几百个零件。但别盲目追求快——我曾经为了赶节拍,把加速度设到极限,结果电机过热报警,反而停机半小时。
时间优化的核心是:在不超过电机额定扭矩的前提下,尽可能缩短运动时间。常用的方法有梯形速度规划、S形速度规划。
3.2 平滑度指标
平滑度,说白了就是机器人抖不抖。你想想看,如果加速度突然变化,整个龙门架都会晃。我见过最夸张的一次,某厂家的机器人因为轨迹不平滑,把工件甩飞了。
衡量平滑度的指标是加加速度(Jerk):
Jerk = d³q/dt³ // 加速度的变化率
加加速度越小,运动越柔和。一般建议控制在50 m/s³以内,超过100 m/s³就会有明显抖动。
避坑指南:
我曾经遇到过一台龙门机器人,运行时末端抖动厉害。查了半天,发现是轨迹规划时加加速度设成了500 m/s³。降到50后,问题立刻解决。所以,平滑度不是锦上添花,是刚需。
3.3 能耗指标
能耗这事,很多人不重视。但你想,一条产线几十台机器人,一年电费几十万。如果每台能省10%,那就是几万块。
能耗优化的核心是:减少不必要的加减速。匀速运动最省电,频繁启停最费电。我有个习惯:在满足节拍的前提下,尽量让机器人跑匀速。
另外,再生能量也要考虑。龙门机器人减速时,电机会发电。如果能把这部分能量回收,能省不少电。不过,这需要驱动器支持,不是所有厂家都做得好。
四、知识体系总览
说了这么多,咱们用一张图来总结本章的核心内容:
五、本章小结
好了,咱们捋一捋今天的内容:
- 轨迹规划就是生成位置、速度、加速度随时间变化的曲线
- 关节空间简单高效,适合点到点运动;笛卡尔空间路径可控,适合连续轨迹
- 三大指标:时间、平滑度、能耗,三者互相制约
- 实际工程中,平滑度优先,别为了赶时间牺牲稳定性
最后说句掏心窝的话:轨迹规划这事,理论不难,难在工程经验。你光看书本上的S形曲线、梯形曲线,不如去现场调一次参数。我当年也是被撞了几次机、烧了几个电机,才真正理解什么叫「平滑度比速度重要」。
下一章咱们聊具体的轨迹规划算法,梯形速度规划和S形速度规划。到时候我会把代码贴出来,咱们一行一行地讲。