文章目录
一、问题描述
给定插补长度 L L L,速度限制 v l i m v_{lim} vlim,加速度限制 a l i m a_{lim} alim,加加速度限制 j l i m j_{lim} jlim,计算总运动时间 T T T,规划归一化7次多项式 s ( u ) s(u) s(u) ( u = t / T u=t/T u=t/T为归一化变量),使其满足以下条件:
{ s ( 0 ) = 0 s ′ ( 0 ) = 0 s ′ ′ ( 0 ) = 0 s ′ ′ ′ ( 0 ) = 0 s ( 1 ) = 1 s ′ ( 1 ) = 0 s ′ ′ ( 1 ) = 0 s ′ ′ ′ ( 1 ) = 0 (1) \begin{cases} s(0)=0 \\ s'(0)=0 \\ s''(0)=0 \\ s'''(0)=0 \\ s(1)=1 \\ s'(1)=0 \\ s''(1)=0 \\ s'''(1)=0 \\ \tag 1 \end{cases} ⎩⎪⎪⎪⎪⎪⎪⎪⎪⎪⎪⎪⎪⎪⎨⎪⎪⎪⎪⎪⎪⎪⎪⎪⎪⎪⎪⎪⎧s(0)=0s′(0)=0s′′(0)=0s′′′(0)=0s(1)=1s′(1)=0s′′(1)=0s′′′(1)=0(1)
并使得,7次多项式轨迹 l ( t ) l(t) l(t)的最大速度 v m a x v_{max} vmax,最大加速度 a m a x a_{max} amax,最大加加速度 j m a x j_{max} jmax满足:
{ v m a x ≤ v l i m a m a x ≤ a l i m j m a x ≤ j l i m (2) \begin{cases} v_{max}\leq v_{lim} \\ a_{max}\leq a_{lim} \\ j_{max}\leq j_{lim} \\ \tag 2 \end{cases} ⎩⎪⎨⎪⎧vmax≤vlimamax≤alimjmax≤jlim(2)
二、推导步骤
设归一化7次多项式为:
s ( u ) = a 0 + a 1 u + a 2 u 2 + a 3 u 3 + a 4 u 4 + a 5 u 5 + a 6 u 6 + a 7 u 7 , u ∈ [ 0 , 1 ] (3) s(u)=a_0+a_1u+a_2u^2+a_3u^3+a_4u^4+a_5u^5+a_6u^6+a_7u^7,u\in[0,1]\tag 3 s(u)=a0+a1u+a2u2+a3u3+a4u4+a5u5+a6u6+a7u7,u∈[0,1](3)
一阶导数为:
s ′ ( u ) = a 1 + 2 a 2 u + 3 a 3 u 2 + 4 a 4 u 3 + 5 a 5 u 4 + 6 a 6 u 5 + 7 a 7 u 6 (4) s'(u)=a_1+2a_2u+3a_3u^2+4a_4u^3+5a_5u^4+6a_6u^5+7a_7u^6\tag 4 s′(u)=a1+2a2u+3a3u2+4a4u3

最低0.47元/天 解锁文章
1020

被折叠的 条评论
为什么被折叠?



