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

【关于四足机器人那些事】腿部运动学建模(三维)

人工智能 我是。 3161次浏览 0个评论

本篇将会三维空间中,对四足机器人的腿部进行数学建模,求解器正逆运动学解,包含详细公式推导与计算   首先,我们来看三维空间中简图:  





  其中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)

 
【关于四足机器人那些事】腿部运动学建模(三维)   在已知xyz的情况下,通过勾股定理我们能够轻易求出H ,在正视图我们需要的公式就这么多,接下来转到右视图

右视图

 

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



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

  此时H 是在L1,L2组成的平面当中,如果空间感比较好的小伙伴应该会发现这时候其实跟二维情况下的几何模型是一致的。因此我们有以下关系:  
【关于四足机器人那些事】腿部运动学建模(三维)  

2、逆解(已知xyz)

 
【关于四足机器人那些事】腿部运动学建模(三维)  

整理

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

1、正解

 
【关于四足机器人那些事】腿部运动学建模(三维)  

2、逆解

 
【关于四足机器人那些事】腿部运动学建模(三维)  

同样,需要根据机器人各个关节的初始角度对θ0,θ1,θ2进行一定相加减

 




如果觉得ok,点个赞,点个关注,也欢迎给个打赏支持一下编者的工作




开心洋葱 , 版权所有丨如未注明 , 均为原创丨未经授权请勿修改 , 转载请注明【关于四足机器人那些事】腿部运动学建模(三维)
喜欢 (0)

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

加载中……