[发明专利]一种双足机器人的定位方法、装置及机器人

说明书

本发明属于机器人技术领域，提供一种双足机器人的定位方法、装置及机器人，该方法包括：获取机器人在世界坐标系下的第一质心位置，建立机器人的第一本体坐标系；经过第一预设时间间隔获取机器人在世界坐标系下移动的第一位移；将第一位移投影到第一本体坐标系的X轴上，获取投影到第一本体坐标系的X轴上的第二位移；将第二位移转换到世界坐标系下获得第一位移增量；根据第一质心位置和第一位移增量确定第二质心位置；当在第一时刻检测到机器人的前向速度不为零且转向速度为零时，将第二质心位置确定为机器人的定位位置。可以使得获取的机器人导航过程中的实时定位更准确，保证机器人顺利到达导航的目的地，从而使得智能导航的准确率高。

技术领域

本发明属于机器人技术领域，尤其涉及一种双足机器人的定位方法、装置及机器人。

背景技术

随着科学技术的不断发展，机器人已经应用在各行各业，移动机器人是在具体应用场景下能实现自规划、自组织和自适应的机器人，具有轮式底盘的机器人可以平稳顺滑的移动，因而在需要进行地面移动的应用场景中得到了广泛的应用。

当应用场景的环境较为复杂时，具有轮式底盘的移动机器人已经难以满足实际应用需求，双足机器人是一种模仿人类移动方式的机器人，由于双足机器人的运动过程更像人类，因此双足机器人更适合在实际环境较复杂的应用场景中工作，在机器人的相关导航算法(如局部导航算法)中需要基于机器人当前的局部信息，如机器人的局部质心位置信息。当将相关导航算法应用在双足机器人中，由于双足机器人在行走的过程中会有比较明显的左右晃动，导致在导航过程中进行定位有偏差导致定位不准确，不能保证双足机器人顺利到达导航的目的地，从而使得智能导航的准确率低。

发明内容

有鉴于此，本发明实施例提供了一种双足机器人的定位方法、装置及机器人，旨在解决现有双足机器人在行走的过程中会有比较明显的左右晃动，导致在导航过程中的局部定位不准确的问题。

本申请实施例的第一方面提供一种双足机器人的定位方法，包括：

当获取到定位的请求指令时，将当前时刻作为第一时刻；

在所述第一时刻，获取机器人在世界坐标系下的第一质心位置，并建立所述机器人当前的第一本体坐标系；其中，所述第一本体坐标系是以所述机器人在世界坐标系下的质心位置为原点，并分别以所述机器人向前朝向为X轴和所述机器人左侧朝向为Y轴建立的坐标系；

在经过第一预设时间间隔时，获取所述机器人在世界坐标系下移动的第一位移；

将所述第一位移投影到在所述第一时刻时所述第一本体坐标系的X轴上，获取投影到所述第一本体坐标系的X轴上的第二位移；

将所述第二位移转换到所述世界坐标系下获得第一位移增量；

根据所述第一质心位置和所述第一位移增量确定所述机器人在所述经过第一预设时间间隔时的第二质心位置；

当在所述第一时刻检测到所述机器人的前向速度不为零且转向速度为零时，将所述第二质心位置确定为所述机器人在所述经过第一预设时间间隔时的定位位置。

在一个实施例中，所述定位方法还包括：

若在所述第一时刻检测到所述机器人的前向速度不为零，且转向速度不为零，根据所述第二质心位置建立所述机器人的第二本体坐标系；其中，所述第二本体坐标系是以所述第二质心位置为原点，并分别以所述机器人在所述经过第一预设时间间隔时的向前朝向为X轴和左侧朝向为Y轴建立的坐标系；

根据经过第一预设时间间隔时所述第一本体坐标系的原点和所述第二本体坐标系的原点获取第三位移；其中，所述第三位移以所述第二本地坐标系的原点为起点，以所述第一本地坐标系的原点为终点；

将所述第三位移投影到所述第二本体坐标系的X轴上，获取投影到所述第二本体坐标系的X轴上的第四位移；