(机器人学导论--运动学)(五)机械臂轨迹规划:三次多项式

轨迹

  • 轨迹即是机械臂末端点或者某操作点的位置速度加速度的历程
    在这里插入图片描述
  • 理想轨迹
    在这里插入图片描述

Joint Space下的轨迹规划

  • 定义机械臂末端点相对于物体的初始位置、中间位置、最终位置的转移矩阵
  • 由转移矩阵通过IK得到每个Joint的θ
  • 将所有θ进行轨迹规划
  • FK验证结果
    在这里插入图片描述

在这里插入图片描述

三次多项式规划

  • 每两点之间用一个三次多项式表示
    在这里插入图片描述
  • 4个已知边界条件(两个点的速度和加速度为达到smooth的效果需要前后一致)
    在这里插入图片描述
    在这里插入图片描述

以矩阵的方式运算

在这里插入图片描述

如何选择速度和加速度

  • 速度
    在这里插入图片描述
  • 加速度需连续
    在这里插入图片描述

Example: A trajectory with one via point

  • 分别用两个多项式表达两段轨迹
    在这里插入图片描述
  • 已知条件:4个位置信息 起始点和终点的速度信息*2 中间点的前后速度和加速度两段轨迹要一致 * 2 = 8
    在这里插入图片描述
  • 代数求解
    在这里插入图片描述
  • 矩阵求解
    在这里插入图片描述

一般情况

  • N+1个轨迹点 4N个未知数
    在这里插入图片描述
  • 位置信息可建立2N个等式
  • 中间点的速度和加速度可以建立2(N-1)个等式
    在这里插入图片描述
  • 最后两个等式靠起始点和终点的速度和加速度建立
    在这里插入图片描述

Example: A RRR Manipulator

在这里插入图片描述

笛卡尔坐标系下规划

  • 直接使用 xyθ规划
    在这里插入图片描述
    在这里插入图片描述
    在这里插入图片描述
    在这里插入图片描述

关节坐标系下规划

在这里插入图片描述
在这里插入图片描述
在这里插入图片描述

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值