一种基于4D毫米波雷达的无人灭火机器人导航方法及装置

本申请提供了一种基于4D毫米波雷达的无人灭火机器人导航方法及装置，解决了现有在一线火场环境下，无法精准捕捉有效数据进行定位导航从而无法精准灭火的技术问题。其包括获取机器人的初始姿态角、局部地图和最优路径，根据最优路径对机器人进行导航；获取特征点云，对特征点云和局部地图进行预处理，得到预处理后的特征点云集合和预处理后的局部地图，进行基于变种ICP算法的点云匹配得到位姿变化参数，与机器人的初始姿态角进行叠加形成增量式的里程计，得到初步估计机器人的实时运动状态，进行修正得到高精度的机器人定位以及运动状态，循环此过程直至到达火源位置后喷水灭火。本申请可广泛应用于机器人导航的技术领域。