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

其中a表示髋关节距离主体得偏移，L1，L2共面，与a保持垂直关系，[x,y,z]表示足端相对于髋关节的位置，为了更容易大家理解，我们将视角转换到不同的视图当中去计算几何关系。

一、正视图：

首先来回一下小学知识：

通过互余我们可以证明a与y轴的夹角与图中所示 $θ_{0}$ 相等。通过其数量关系，我们可以得出：

1、正解（已知 $θ_{0}$ ）

$z = - H cos (θ_{0}) + a sin (θ_{0}) (1-1)$ $y = a cos (θ_{0}) + H sin (θ_{0}) (1-2)$ 此时，我们只要求出，即可得到与的值

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

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

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

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

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

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

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

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

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