关节空间轨迹轨迹(关节角度三次多项式插值小记)

三次多项式:

        1.位移

                \theta(t)=a_{0}+a_{1} t+a_{2} t^{2}+a_{3} t^{3}

        2.速度

        ​​​​​​​        \dot{\theta}(t)=a_{1}+2 a_{2} t+3 a_{3} t^{2}

        3.加速度

        ​​​​​​​        \ddot{\theta}(t)=2 a_{2}+6 a_{3} t

        在实际工作中,以六自由度旋转关节若此时我们已知需要到达的目标位置,通过运动学求逆解得到关节需要到达的角度位置。

        假设我们已知关节的初始角度、求得的目标角度位置;而初始时,关节的角速度必然为0,结束时,目标角度位置的速度也为0,则可以得到以下四个约束方程:

        \\\theta(0)=\theta_{0}\\\theta\left(\mathrm{t}_{f}\right)=\theta_{f}          \\\dot{\theta}(0)=0\\\dot{\theta}(t_f)=0

将上面四个边界条件代入上面的公式1,我们可以得到四个系数的表达式:

\\a_{0}=\theta_{0} \\a_{1}=0 \\a_{2}=\frac{3}{t_{f}^{2}}\left(\theta_{f}-\theta_{0}\right)\\ a_{3}=-\frac{2}{t_{f}^{3}}\left(\theta_{f}-\theta_{0}\right)

至此,关节运动轨迹的三次多项式插值表达式求出。

  • 3
    点赞
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值