移动机器人的航向角融合方法、装置和移动机器人

摘要

本申请涉及移动载体位姿估计技术领域，尤其涉及一种移动机器人的航向角融合方法、装置和移动机器人，包括获取移动机器人的IMU测量系统检测的IMU初始航向角和IMU行进航向角，以及UWB测量系统检测的UWB行进航向角；根据所述IMU初始航向角和所述UWB行进航向角之间的差值确定初始修正偏置角，并将所述IMU行进航向角的天向角速度与预设角速度阈值进行比对；若所述天向角速度小于所述预设角速度阈值，则获取在小于所述预设角速度阈值的持续时间段内的动态修正偏置角，并根据所述初始修正偏置角和所述动态修正偏置角确定实时修正偏置角；本方案的融合过程较为简便，计算结果较为稳定可靠，能够保证移动机器人在室内封闭环境下获取更为可靠、准确的航向信息。