本篇将会三维空间中,对四足机器人的腿部进行数学建模,求解器正逆运动学解,包含详细公式推导与计算   首先,我们来看三维空间中简图:  
  其中a表示髋关节距离主体得偏移,L1,L2共面,与a保持垂直关系,[x,y,z]表示足端相对于髋关节的位置,为了更容易大家理解,我们将视角转换到不同的视图当中去计算几何关系。  

一、正视图:

 
  首先来回一下小学知识:  
  • 互余:如果两个锐角的和等于90度,那么这两个锐角互为余角
  通过互余我们可以证明a与y轴的夹角与图中所示θ0相等。通过其数量关系,我们可以得出:  

1、正解(已知θ0

  z=Hcos(θ0)+asin(θ0)(1-1) y=acos(θ0)+Hsin(θ0)(1-2)   此时,我们只要求出H ,即可得到z y 的值  

2、逆解(已知x,y,z)

  QQ截图20210204122048   在已知xyz的情况下,通过勾股定理我们能够轻易求出H ,在正视图我们需要的公式就这么多,接下来转到右视图

右视图

 
虽说是右视图,但我们最好不要将其想象成水平向右观看的视图,这里的右视图指的是L1,L2所在平面的视图。这里其实跟二维情况下无疑。H的长度相当于原本的Y轴上的距离。这里就不再重新推导,详情请查看文章

1、正解(已知θ1,θ2

  此时H 是在L1,L2组成的平面当中,如果空间感比较好的小伙伴应该会发现这时候其实跟二维情况下的几何模型是一致的。因此我们有以下关系:   QQ截图20210204122314  

2、逆解(已知xyz)

  QQ截图20210204122336  

整理

  我们将所有公式整理一下:  

1、正解

  QQ截图20210204122357  

2、逆解

  微信截图_20210204122418  
同样,需要根据机器人各个关节的初始角度对θ0,θ1,θ2进行一定相加减
 
如果觉得ok,点个赞,点个关注,也欢迎给个打赏支持一下编者的工作