[发明专利]双足机器人的运动轨迹规划方法、装置、设备及介质

权利要求书

1.一种双足机器人的运动轨迹规划方法，其特征在于，包括：

若确定控制所述双足机器人从当前台阶移动至第一台阶，则获取所述双足机器人的质心的目标运动轨迹，所述质心的目标运动轨迹通过对质心在至少两个方向上的运动轨迹叠加得到，且各方向上的运动轨迹采用不同的轨迹规划算法得到，所述第一台阶为所述当前台阶的下一台阶；

分别获取所述当前台阶的预设落脚点位置信息和台阶参数，所述台阶参数包括：台阶的高度参数、台阶的深度参数；

根据所述当前台阶的预设落脚点位置信息和台阶参数，规划获取所述双足机器人移动过程中腾空脚的运动轨迹；

根据所述质心的目标运动轨迹和所述腾空脚的运动轨迹，控制所述双足机器人从所述当前台阶移动至所述下一台阶；

所述根据所述当前台阶的预设落脚点位置信息和台阶参数，规划获取所述双足机器人移动过程中腾空脚的运动轨迹，包括：

根据所述当前台阶的预设落脚点位置信息和台阶参数，分别获取所述第一台阶、第二台阶的预设落脚点位置信息，所述第二台阶为所述第一台阶的下一台阶；

根据所述当前台阶的预设落脚点位置信息、所述第一台阶的预设落脚点位置信息以及所述第二台阶的预设落脚点位置信息，采用二阶贝塞尔曲线获取所述双足机器人移动过程中腾空脚的运动轨迹。

2.根据权利要求1所述的方法，其特征在于，所述质心的目标运动轨迹通过对质心在第一方向上的第一运动轨迹、质心在第二方向上的第二运动轨迹以及质心在第三方向上的第三运动轨迹叠加得到，其中，所述第一方向、所述第二方向以及所述第三方向中任意两个方向相垂直。

3.根据权利要求2所述的方法，其特征在于，所述第一方向与所述第二方向所在的平面与所述当前台阶的上表面平行，所述第一方向与所述第三方向所在的平面与所述当前台阶的上表面垂直。

4.根据权利要求3所述的方法，其特征在于，所述质心的目标运动轨迹包括下述至少一段：第一叠加运动轨迹、第二叠加运动轨迹、第三叠加运动轨迹；

其中，第一叠加运动轨迹，通过对第一运动轨迹和质心在第二方向上朝接近支撑腿的方向运动的运动轨迹进行叠加得到；

第二叠加运动轨迹，通过对第一运动轨迹、第三运动轨迹以及质心在第二方向上朝远离支撑腿的方向运动的运动轨迹进行叠加得到；

第三叠加运动轨迹，通过对第一运动轨迹、第三运动轨迹以及质心在第二方向上朝接近支撑腿的方向运动的运动轨迹进行叠加得到。

5.根据权利要求1-4任一项所述的方法，其特征在于，所述轨迹规划算法包括下述至少一项：倒立摆模型、梯形速度曲线规划算法。

6.一种双足机器人的运动轨迹规划装置，其特征在于，包括：

获取模块，用于若确定控制所述双足机器人从当前台阶移动至第一台阶，则获取所述双足机器人的质心的目标运动轨迹，所述质心的目标运动轨迹通过对质心在至少两个方向上的运动轨迹叠加得到，且各方向上的运动轨迹采用不同的轨迹规划算法得到，所述第一台阶为所述当前台阶的下一台阶；

控制模块，用于根据所述质心的目标运动轨迹，控制所述双足机器人从所述当前台阶移动至所述第一台阶；

所述控制模块，用于分别获取所述当前台阶的预设落脚点位置信息和台阶参数，所述台阶参数包括：台阶的高度参数、台阶的深度参数；

根据所述当前台阶的预设落脚点位置信息和台阶参数，规划获取所述双足机器人移动过程中腾空脚的运动轨迹；

根据所述质心的目标运动轨迹和所述腾空脚的运动轨迹，控制所述双足机器人从所述当前台阶移动至所述下一台阶；

所述控制模块，具体用于根据所述当前台阶的预设落脚点位置信息和台阶参数，分别获取所述第一台阶、第二台阶的预设落脚点位置信息，所述第二台阶为所述第一台阶的下一台阶；

根据所述当前台阶的预设落脚点位置信息、所述第一台阶的预设落脚点位置信息以及所述第二台阶的预设落脚点位置信息，采用二阶贝塞尔曲线获取所述双足机器人移动过程中腾空脚的运动轨迹。