本篇将会三维空间中,对四足机器人的腿部进行数学建模,求解器正逆运动学解,包含详细公式推导与计算 首先,我们来看三维空间中简图:
一、正视图:
- 互余:如果两个锐角的和等于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,点个赞,点个关注,也欢迎给个打赏支持一下编者的工作