当前位置:   article > 正文

(机器人学导论--运动学)(四)逆向运动学_pieper's solution

pieper's solution

逆向运动学概念

在这里插入图片描述

求解概念

可达工作空间&灵活工作空间

在这里插入图片描述

子空间

  • 手臂能够到达的变动范围
    在这里插入图片描述

求解目标

  • 手臂有六个自由度
  • 转移矩阵有16个数字 其中最下面4个数字为常数 其余12个数字对应12个非线性超越方程
  • 需要解出6个未知数 ,故需要六个限制条件
    在这里插入图片描述

多重解

在这里插入图片描述

  • PMUA为例
  • 对于一个工作点 前三轴有三种姿态满足 后三轴有两种姿态满足 故一共八种解
    在这里插入图片描述
  • 多重解的选择方式
    在这里插入图片描述

求解方法

在这里插入图片描述

RRR机械臂求解实例

在这里插入图片描述

几何法

在这里插入图片描述

在这里插入图片描述

  • 第二解
    在这里插入图片描述

代数法

  • 先求解θ2 若求出来的cosθ2 >1 | <-1 则此工作点不可到达
  • θ2有两解
    在这里插入图片描述
  • 将θ2代入
    在这里插入图片描述
    在这里插入图片描述

三角函数解法

  • 如上面会遇到acosθ+bsinθ = c的问题
    在这里插入图片描述

Pieper’s solution(三轴交于一点)

  • 后三轴交于一点
    在这里插入图片描述
  • 先求解移动部分
    在这里插入图片描述
    在这里插入图片描述

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

  • 旋转部分用ZYZ Euler Angle求解
    在这里插入图片描述
  • 注意ZYZ Euler Angle 和 DH表达法的区别
  • 下图中红色坐标系为Euler Angle 绿色为DH表达法
  • Euler Angle是绕着自身坐标系轴转动
  • DH表达法中 都是绕着Z轴旋转
  • Euler Angle中第五轴需要绕着Euler Angle的Y 轴转动 故DH表达法中θ4需要转多180°才能DH下的Y轴与Euler Angle下的Y 轴重合
    在这里插入图片描述

Example: 物件取放任務

在这里插入图片描述

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

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

声明:本文内容由网友自发贡献,不代表【wpsshop博客】立场,版权归原作者所有,本站不承担相应法律责任。如您发现有侵权的内容,请联系我们。转载请注明出处:https://www.wpsshop.cn/w/weixin_40725706/article/detail/535336
推荐阅读
相关标签
  

闽ICP备14008679号