1.一种应用于火灾救援的机器人路径寻优方法，基于ROS机器人作为搭载平台，机器人顶部搭载激光雷达，其特征在于，包括以下步骤：步骤1：利用激光雷达发射光线粒子，接收器接收发射出去的光线粒子，最终获取机器人的里程计数据；

步骤2：基于激光雷达采集到的里程计数据，采用RBPF算法改进Gmapping算法，构建二维栅格地图；

步骤3：对Gmapping算法引入改进的粒子群最优化算法PSO对采样后的粒子群进行更新，构建完整地图信息；所述改进的粒子群最优化算法PSO将粒子的适应度值看作粒子权值，在粒子群中挑选出所有有效粒子数量，执行重采样操作；并对重采样优化，将粒子群按照权重大小进行分类，复制粒子群中的权重大于均值的粒子，对于权重小于均值的粒子修正后按照比例回收；

步骤4：根据步骤3中的到的完整地图信息，采用优化RRT算法对全局路径规划结合优化TEB算法对局部路径规划，两者结合，实现在火灾环境下的最优动路径规划，从而完成最优避障；

利用快速搜索随机树RRT算法对全局路径规划，在路径规划过程中引入目标动态概率OO

其中，F

所述快速搜索随机树RRT算法通过梯度下降法对初始路径进行再次优化，通过迭代方法求解出最小化优化函数，从而优化目标值；通过梯度下降法设计出的优化函数公式为：P＝ω

其中，P

其中，(x

其中，σ

所述步骤4中的时间弹性带算法TEB进行局部路径规划时，机器人在运行过程中其搭载的激光雷达测算出机器人与障碍物的实时距离d构建TEB算法模型，需要计算每个位姿点的约束值总和f(T)，约束总和计算公式如下：其中，f

时间弹性带算法TEB进行局部路径规划时，对原路径进行弹性变形后，机器人的速度随之发生变化，导致轨迹也发生变化；机器人的线速度v其中，r为偏移半径；θ

调整两个位姿点的时间间隔，并且减少需要计算的位姿点(x

2.根据权利要求1所述的一种应用于火灾救援的机器人路径寻优方法，其特征在于，所述步骤2中的Gmapping算法以激光雷达使用SLAM中的RBPF算法完成二维栅格地图构建为前提，实时构建二维栅格地图，具体方法为：首先对机器人运动轨迹的预测，由贝叶斯法则得：p(x

其中，u

参照粒子滤波方法，粒子状态预测，测量，更新，重采样进一步说明：

1)粒子状态预测：粒子状态预测先对运动模型更新，机器人进行旋转或平移的过程中产生噪声干扰，在滤波中采用高斯采样进行去噪；

2)测量：对地图信息进行一次扫描，与预估值进行匹配，在地图中找到机器人的位姿，改进里程计模型的提议分布，具体如下：获取粒子最优的位姿后，扩大粒子的采样范围至模型峰值区域L其中，z

每个点的因子η

3)重采样：计算每个粒子的权重，利用激光雷达数据对提议分布进行优化，优化公式为：粒子的权重经过优化之后，权重公式为：为减少粒子的丢失现象，引入权重值离差N其中，

3.根据权利要求1所述的一种应用于火灾救援的机器人路径寻优方法，其特征在于，所述步骤3中引入改进的粒子群最优化算法PSO对采样后的粒子群进行更新，具体操作如下：

1)将粒子最新控制量u

其中，x

2)改进的粒子群最优化算法PSO对粒子t时刻的速度更新：v

其中，x'

得到粒子在t时刻的位姿x

其中，V

3)将粒子的适应度值作为权值，在粒子群中挑选出所有有效粒子，执行重采样操作，重采样操作具体如下：首先将粒子X按照权重大小进行排序，小权重粒子的编号为D+1～N-1，小权重粒子选择大权重粒子作为模板，通过计算得出两者之间的差距：其中，x,y,θ为粒子的位姿；i；j为粒子的序号；

根据正态分布N(0,σ

最后得出修正后的粒子：

其中，n

将回收得到的粒子重新扫描，不断更新粒子的权重，从权重小的粒子群中的选出N-N

4.根据权利要求3所述的一种应用于火灾救援的机器人路径寻优方法，其特征在于，经过改进的粒子群最优化算法PSO优化后的Gmapping算法进行构建完整地图信息具体步骤如下：第一步：激光雷达开始工作，根据里程计和激光雷达在t时刻的位姿，设置初始变量u第二步：激光雷达数据转化为粒子，粒子群最终形成点云数据，点云数据与火灾现场环境进行线性拟合，对粒子群进行局部扫描，并判断点云集波动值是否超出设定的阈值，如果是，则执行下一步；反之，减少粒子数；

第三步：根据步骤2中优化的分布提议进行粒子采样，对采样得到的粒子集进行更新并进行适应度值得到粒子权重；

第四步：将粒子群中的所有粒子根据权重大小进行高低排序，并将粒子群分为高权重和低权重两个子种群；

第五步：对高权重子种群进行权重均值求解，并且设置高权重粒子的复制次数N第六步：对N-N

第七步：均分高权重粒子和低权重粒子位姿权重；

第八步：计算优化后粒子群的有效粒子数N第九步：更新地图信息。