本发明公开了一种应用于火灾救援的机器人路径寻优方法，步骤包括：ROS机器人搭载的激光雷达采集周围的环境信息，获取机器人的里程计数据；基于激光雷达采集到的里程计数据，Gmapping算法经过SLAM中的RBPF算法改进提议分布与重采样策略；采用改进粒子群算法优化Gmapping算法，根据ROS机器人的里程计、激光雷达数据来绘制地图；对于所绘制的地图，采用RRT算法、TEB算法进行全局路径规划和局部路径规划，实现ROS机器人的避障的最优路径规划。与现有技术相比，本发明缩短了火灾现场的地图采集时间，搜救人员不需要冒险进入险情中进行地图勘测，保障了搜救工作人员的安全性。