[发明专利]双足机器人的姿态测量方法、装置、设备及存储介质

说明书

本申请提供一种双足机器人的姿态测量方法、装置、设备及存储介质，涉及双足机器人技术领域。该方法包括：计算着地时刻腾空脚足端到躯干的第一位姿变换矩阵和支撑脚足端到躯干的第二位姿变换矩阵；根据第一位姿变换矩阵和第二位姿变换矩阵，计算腾空脚足端相对支撑脚足端的位置变换矩阵；根据位置变换矩阵和着地时刻支撑脚的位置，计算腾空脚在着地时刻的第一位置；根据第一位置，计算着地时刻双足机器人的位姿参数，应用本申请实施例，实现了可以根据腾空脚在着地时刻的第一位置作为下一步运动状态记录的支撑脚的位置，进而可以基于该计算得到支撑脚的位置计算得到着地时刻双足机器人的位姿参数，减少测量误差，得到较为准确的位姿测量结果。

技术领域

本申请涉及双足机器人技术领域，特别涉及一种双足机器人的姿态测量方法、装置、设备及存储介质。

背景技术

仿人机器人即模仿人的形态和行为而设计制造的机器人，一般分别或同时具有仿人的四肢和头部，可以适应人类的生活和工作环境，代替人类完成各种作业，被广泛应用在服务、医疗、教育、娱乐等多个领域。

现有的仿人机器人在进行姿态测量时，一般需要通过外部传感器辅助实现平面地形下的自身姿态测量。

但由于现有的测量方法比较简单，因此，将其应用于崎岖地面的姿态测量时存在较大的测量误差。

发明内容

本申请的目的在于，针对上述现有技术中的不足，提供一种双足机器人的姿态测量方法、装置、设备及存储介质，可以测量得到双足机器人较为准确的姿态参数。

为实现上述目的，本申请实施例采用的技术方案如下：

第一方面，本发明提供一种双足机器人的姿态测量方法，包括：

根据双足机器人在腾空脚着地时刻的躯干倾角和所述着地时刻的预设关节的位置，分别计算着地时刻所述腾空脚足端到躯干的第一位姿变换矩阵，和支撑脚足端到躯干的第二位姿变换矩阵；

根据所述第一位姿变换矩阵和所述第二位姿变换矩阵，计算所述腾空脚足端相对所述支撑脚足端的位置变换矩阵；

根据所述位置变换矩阵和所述着地时刻所述支撑脚的位置，计算所述腾空脚在所述着地时刻的第一位置；

根据所述第一位置，计算所述着地时刻所述双足机器人的位姿参数。

在可选的实施方式中，所述方法还包括：

根据所述双足机器人在双足支撑状态的躯干倾角和所述双足支撑状态的预设关节的位置，计算所述双足支撑状态下双脚足端到躯干的位姿变换矩阵；

根据所述双足支撑状态下双脚足端到躯干的位姿变换矩阵和双脚的位置，对所述双足机器人的躯干位置进行校正；

根据校正后的所述双足机器人的躯干位置，计算所述双足支撑状态下所述双足机器人的位姿参数。

在可选的实施方式中，所述根据所述双足支撑状态下双脚足端到躯干的位姿变换矩阵和双脚的位置，对所述双足机器人的躯干位置进行校正，包括：

计算获取双脚支撑比例；

根据所述双足支撑状态下双脚足端到躯干的位姿变换矩阵、双脚的位置以及所述双脚支撑比例，对所述双足机器人的躯干位置进行校正。

在可选的实施方式中，所述计算获取双脚支撑比例，包括：

根据所述双足支撑状态下所述双脚的支撑重量和所述双足机器人的重量，分别计算所述双脚支撑比例。

在可选的实施方式中，所述计算获取双脚支撑比例，包括：

根据所述双足支撑状态下所述双脚的位置和所述双足机器人的质心位置，分别计算所述双脚支撑比例。