常用方法
三次曲线,五次曲线,梯形曲线,S曲线
背景知识
冲击
类别
1)刚性冲击
在运动的起点和终点处,速度发生突变。此时加速度理论上为无穷大,产生无穷大的惯性力,机构将产生极大的冲击,称为刚性冲击。
2)柔性冲击
柔性冲击是相对于刚性冲击而言的。在运动的起点和终点,速度没有突变,因此不存在刚性冲击;但加速度产生突变,产生较大的惯性力,由此引起的冲击称为柔性冲击。
区别
输入→输出
刚性冲击→速度突变
柔性冲击→加速度突变
影响
输入→输出
刚性冲击→无穷大惯性力,极大冲击
柔性冲击→较大惯性力
方法对比
三次曲线
公式
s(t)=a0+a1t+a2t2+a3t3
输入
s(0)
s(T)
s˙(0)
s˙(T)
输出
a0
a1
a2
a3
曲线
特点
s˙(0)
s˙(T)不连续,即有冲击
五次曲线
公式
s(t)=a0+a1t+a2t2+a3t3+a4t4+a5t5
输入
s(T)
s˙(0)
s˙(T)
s¨(0)
s¨(T)
输出
a0
a1
a2
a3
a4
a5
曲线
特点
s˙(0)
s˙(T)连续,消除三次曲线缺点
梯形曲线
公式
0≤t≤av:s(t)=21at2
av≤t≤T−av:s(t)=vt−2av2
T−av≤t≤T:s(t)=2a2avT−2v2−a2(t−T)2
输入
s(T)
ta=av(指定v,a v,T或a,T)
输出
1)指定v,a→T
2)指定v,T→a
3)指定a,T→v
曲线
特点
t=0,
ta,
T−ta,
T四个时刻加速度不连续,存在冲击
场景
电机控制中常用。
S曲线
公式
J=Tfva−v2−aa2v,
t1=Ja,
t2=av−Ja,
t3=Ja,
t4=v2−T,
t5=Ja,
t6=av−Ja,
t7=Ja
Section1:
以恒定的痉挛J(加速度的导数)使加速度从0增加到预先设定的a
0≤t<t1:s(t)=61Jt3
*Section2:
以恒定的加速度加速
t1≤t<t1+t2:s(t)=21a(t−t1)2+2Ja2(t−t1)+6J2a3
Section3:
已恒定的负的痉挛J(加速度的导数)使加速度从预先设定的a减到0
t1+t2≤t<t1+t2+t3:s(t)=−61J(t−t1−t2)3+21a(t−t1−t2)2+(at2+2Ja2)⋅(t−t1−t2)+21at22+2Ja2t2+6J2a3
Section4:
以恒定的速度v匀速运动
t1+t2+t3≤t<t1+t2+t3+t4:s(t)=(−21Jt32+at3+at2+2Ja2)(t−t1−t2−t3)−61Jt33+21at32+(at2+2Ja2)⋅t3+21at22+2Ja2t2+6J2a3
Section5:
已恒定的负的痉挛J(加速度的导数)使加速度从0减到预先设定的-a
t1+t2+t3+t4≤t<t1+t2+t3+t4+t5:s(t)=1−s(t′)其中t′=T−t
Section6:
以恒定的加速度-a减速
t1+t2+t3+t4+t5≤t<t1+t2+t3+t4+t5+t6:s(t)=1−s(t′)其中t′=T−t
Section7:
以恒定的痉挛J(加速度的导数)使加速度从预先设定的-a增加到0
t1+t2+t3+t4+t5+t6≤t<t1+t2+t3+t4+t5+t6+t7:s(t)=1−s(t′)其中t′=T−t
输入
J,t2,t4
输出
1)
a≤v2 无解
2)
v2<a≤2v2:av+v1<T≤v2
3)
a>2v2:av+1v<T≤a2v+v1
曲线
特点
t=0,
ta,
T−ta,
T四个时刻加速度连续
参考文献
[1]刚性冲击
[2]柔性冲击
[3]点到点轨迹规划——三次曲线,五次曲线,梯形曲线,S曲线