[发明专利]一种六足机器人行走的实现方法

说明书

技术领域

本发明涉及六足机器人，具体涉及一种六足机器人行走的实现方法。

背景技术

六足机器人又叫蜘蛛机器人，是多足机器人的一种，具有稳定性好、承载能力高、地形适应性强等优势，是复杂作业环境下的最佳选择，具有广阔的应用前景。

目前，六足机器人的常见步态以三角步态为主，即将六足分为交替相隔的两组，每组三足，通过两组关节交替起落旋转来实现机器人的前进、转向、后退等行动。三角步态虽然能实现移动、旋转等动作，不仅动作单调生硬、动作的节奏感较强，无法流畅平滑移动；而且由于三角步态的前进动作实际上是通过两个不同方向的交替旋转进行的，无法保持机器人机身正面方向稳定一致，对于有摄像头功能的六足机器人来说，会造成视频画面的剧烈晃动，严重影响视频质量和应用范围。

发明内容

本发明所要解决的技术问题是现有六足机器人的三角步态不仅动作单调生硬、动作的节奏感较强，无法流畅平滑移动，而且无法保持机器人机身正面方向稳定一致的问题。

为了解决上述技术问题，本发明所采用的技术方案是提供一种六足机器人行走的实现方法，包括以下步骤：

步骤S10、控制机器人头部摄像模块旋转到正对目标终点，利用机身坐标系中目标终点坐标计算出机器人行进至目标终点时机身中心平移路径；

步骤S20、利用变换算法建立每足足坐标系与机身坐标系的对应关系，通过机身中心平移路径，计算出每足末端的平移路径；

步骤S30、通过各个足末端在其平移路径竖直平面上的运动轨迹，获得足末端在该运动轨迹不同坐标点上对应的各关节旋转角度，配置关节旋转预设角度；

步骤S40、控制机器人抬起不相邻两足，开始沿平行于机身中心和终点连线的每足末端的平移路径行进，行进时始终保证四足着地，不相邻两足抬起，且每足的各关节按周期旋转到对应预设角度，使每足末端在其平移路径上抬起、落下。

在上述方法中，所述机身中心平移路径的计算方法为：

摄像模块获取目标终点在环境坐标系坐标；

通过变换算法将目标终点在环境坐标系坐标投射到机身坐标系中，获取目标终点机身坐标系坐标；

将机身中心映射到经过目标终点垂直于地面的直线上，通过机身坐标系目标终点坐标得到机身映射中心坐标，机身中心与机身映射中心连线为机身中心平移路径。

在上述方法中，计算每足末端的平移路径以在标准站立姿态下各足末端的位置为参照；

机器人包括髋关节、膝关节和踝关节三个关节，在标准站立姿态下三个关节的角度如下：

髋关节：与机身圆周接触点的切线方向垂直；

膝关节：与机身水平方向平行；

踝关节：使两段肢体成90度，足末端与地面垂直。

在上述方法中，通过变换算法建立每足的足坐标系与机身坐标系的对应关系具体包括以下步骤：

第一步、通过对机身坐标系坐标(x,y)进行旋转，得到足坐标系坐标(x’,y’)为：

其中，θ为机身中心和摄像模块方向连线与机身中心和足根部在机身连接点连线的夹角；

第二步、对坐标(x’,y’)在足坐标系的y轴上平移r，r为机身半径，在x轴上不变，则得到机身坐标系坐标(x,y,z)在足坐标系的坐标(x”,y”,z”)；其中，平移后x”＝x’，y”＝y’+r，由于z轴未发生变换，所以z”＝z。

在上述方法中，在步骤S30中，足末端在运动轨迹不同坐标点上对应的各关节旋转角度采用D-H矩阵进行计算，具体公式为：

足末端的变换矩阵T为：[T]＝[Z₁][Z₂]...[Z_n]；

相邻两连杆间的变换矩阵Z_i为：

其中，θ_i表示运动时各关节绕自身坐标系z轴的旋转角；d_i表示运动时在z轴上各关节之间的偏移；i取值为1至3。

在上述方法中，行进时始终保证四足着地，不相邻两足抬起包括交替抬起不相邻的两足和不相邻的两足交替抬起两种步态，其中，

交替抬起不相邻的两足为：行进开始后，抬起的两足一起落地，着地、不相邻的两足一起抬起；

不相邻的两足交替抬起为：行进开始后，抬起的一足落地，同时着地的四足中一足抬起，且该抬起足与原抬起足不相邻。

在上述方法中，每足按相同周期、不同相位差进行循环动作，使各足平稳交替前进；