[发明专利]一种基于双MEMS-IMU的室内轮式机器人的定位方法

摘要

本发明提供了一种基于双MEMS‑IMU的室内轮式机器人定位方法，首先分别通过第一、第二惯性导航模块采集车轮、车身的运动信息，单独解算得到第一、第二定位信息，包括车轮以及车身的位置、速度、姿态角；再通过第二惯性模块的俯仰角对第一惯性模块的俯仰角进行补偿，进而使用补偿后的俯仰角和第一姿态角估计第一模块的安装角。同时，通过第一惯性模块测量车轮转动角速度换算得到的车体移动速度信息，分别提供给第一、第二惯导模块，分别构建运动约束进行组合解算，进而提升第一、第二定位信息的精度。最后将第一、第二定位信息以及两模块安装位置的空间几何信息组合提升整个系统的定位精度从而实现一种高精度、低成本的室内机器人相对定位方法。

主权项

1.一种基于双MEMS‑IMU的室内轮式机器人定位方法，其特征在于，所述室内轮式机器人包括车轮与车身，所述MEMS‑IMU为微型惯性测量单元，所述微型惯性测量单元包括第一惯性导航模块与第二惯性导航模块，所述方法包括：步骤S101：通过所述第一惯性导航模块采集所述车轮的运动信息，并单独解算获得第一定位信息，其中，所述第一惯性导航模块位于所述车轮的中心，所述第一定位信息包括所述车轮的位置、速度和姿态角；步骤S102：通过所述第二惯性导航模块采集所述车身的运动信息，并单独解算获得第二定位信息，其中，所述第二惯性导航模块位于所述车身的顶部中央，所述第二定位信息包括所述车身的位置、速度和姿态角；步骤S103：通过所述第二惯性导航模块的俯仰角对所述第一惯性导航模块的俯仰角进行补偿，获得补偿后的俯仰角，使用补偿后的俯仰角和所述第一惯导模块的姿态角估计所述第一惯性导航模块的安装角；步骤S104：通过所述第一惯性导航模块测量采集的车轮转动角速度，获得车体移动速度，将车体移动速度分别提供给所述第一惯性导航模块和第二惯性导航模块，并构建第一运动约束进行组合解算，获得组合后的第一定位信息，构建第二运动约束进行组合解算，获得组合后的第二定位信息；步骤S105：基于所述组合后的第一定位信息、所述组合后的第二定位信息以及所述第一惯性模块和第二惯性模块的安装位置的空间关系，获得组合后的第三定位信息。