• 欢迎访问开心洋葱网站,在线教程,推荐使用最新版火狐浏览器和Chrome浏览器访问本网站,欢迎加入开心洋葱 QQ群
  • 为方便开心洋葱网用户,开心洋葱官网已经开启复制功能!
  • 欢迎访问开心洋葱网站,手机也能访问哦~欢迎加入开心洋葱多维思维学习平台 QQ群
  • 如果您觉得本站非常有看点,那么赶紧使用Ctrl+D 收藏开心洋葱吧~~~~~~~~~~~~~!
  • 由于近期流量激增,小站的ECS没能经的起亲们的访问,本站依然没有盈利,如果各位看如果觉着文字不错,还请看官给小站打个赏~~~~~~~~~~~~~!

机器人理论(4)逆向运动学:已知物体位置反推关轴角度

人工智能 aic1999 1782次浏览 0个评论

引言

我们已经知道如何已知角度去推算机械臂末端的位置,那么如何由位置反推出机械臂到达需求位需要的角度呢?  

逆向运动学

基本过程就是已知手臂末端点的位置{H}(机器手head)或者该坐标系相对于世界坐标系{W}的向量,求出关轴的角度
\large \Theta。根据题目题目难度,有时候可以直接求解出角度
\large \Theta,有时候需要借助
\large _{H}^{W}\textrm{T}矩阵算出角度
\large \Theta。   其中求解方法大致分为如下几种方法:解析法(几何法、代数法等)和数值法。  

目录

几何法

代数法

数值法

综合例题

Tips:从多个解中选择的方法


 

几何法

顾名思义,直接利用几何关系和定理求解即可。在这里直接引出经典的PUMA机械臂案例。 【举例】已知
\large x
\large y
\large \varphi,如何求
\large \Theta _{1}
\large \Theta _{2}
\large \Theta _{3}。(
\large x
\large y 为坐标点、
\large \varphi =
\large \Theta _{1} +
\large \Theta _{2} +
\large \Theta _{3} )  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   【求解过程】  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   上图表明了
\large \Theta _{1} 取决于
\large \Theta _{2} 的正负。当
\large \Theta _{2}<0时,
\large \psi属于绿色三角形。当
\large \Theta _{2}>0时,
\large \psi属于蓝色三角形。 得到如图关系式后,就可以开始代入求解了。  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  

代数法

  【例题】和上面例题一样  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   【求解过程】  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   代数,并使用极坐标知识,可以得出:(小声bb:现在才知道高中数学的重要性….)  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  

数值法

列出每个关节的T矩阵,让电脑自己往里面带入数据,数字一个一个跑,直到求出解为止。   反算出
\large \Theta的方法不止一种。由于数值法对电脑算力有要求,解析法(几何法、代数法)因为不需要举出大量数字让计算机去逼近求解,而且求逆矩阵快,所以大部分情况下使用的是解析法求解。然而想要让机械臂能够使用解析法求解,机械臂的设计就要满足一个条件——存在相邻的三轴相交于同一点,这个也称为 Pieper’s Solution。   相关例子 使用经典的符合Pieper条件的PUMA手臂作为例题 ,有
\large _{}^{0}\textrm{P}_{6 org}=
\large _{}^{0}\textrm{P}_{4 org}。 由于前三轴是负责移动的,后三轴负责转动的,为了方便分两步走。   (1)求解
\large \Theta _{1}
\large \Theta _{2}
\large \Theta _{3} (代数法) 由之前讲过的T矩阵的特性,可以得出这个:  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   使用代数法运算,为了方便求解,我们先定义好代数式 f, g  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   可以知道f 是有关
\large \Theta _{3} 的函数,g为有关
\large \Theta _{2}
\large \Theta _{3} 的函数,展开有:  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   在这里先假设代数 K:  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   然后加入并定义代数 r,就有:  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   可以知道r是有关
\large \Theta _{2}
\large \Theta _{3} 的函数。 由于高度Z本身和
\large g_{3}有关,所以它也是一个有关
\large \Theta _{2}
\large \Theta _{3} 的函数。  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   到这一步我们已经得到两个不用考虑
\large \Theta _{1},且与
\large \Theta _{2}
\large \Theta _{3} 有关的函数了,联立起来,有:  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   即可联系已知求解
\large \Theta _{3},然后再依次求解出
\large \Theta _{1}
\large \Theta _{2}。  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   (2)求解
\large \Theta _{4}
\large \Theta _{5}
\large \Theta _{6} 由上式已知我们的
\large \Theta _{1}
\large \Theta _{2}
\large \Theta _{3},并且我们的4,5,6关节都符合pieper条件,就可以直接通过下式算出答案:  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   【这里的求解过程参考(2)】  

综合例题

 
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   【解题过程】  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  
机器人理论(4)逆向运动学:已知物体位置反推关轴角度  

Tips:从多个解中选择的方法

 
机器人理论(4)逆向运动学:已知物体位置反推关轴角度   感谢:课程内容、PPT来自林沛群教授的课程《机器人学》!!!


开心洋葱 , 版权所有丨如未注明 , 均为原创丨未经授权请勿修改 , 转载请注明机器人理论(4)逆向运动学:已知物体位置反推关轴角度
喜欢 (0)

您必须 登录 才能发表评论!

加载中……