1.一种具备路径规划功能的搜救ROV控制系统,其特征在于,包括:
水下环境栅格地图模型建立模块,用以通过水下机器人的工作环境构建水下环境栅格地图模型;
路径规划模块,用以通过采用改进的遗传算法对路径进行规划得到良好路径,改进的遗传算法对路径进行规划的过程为:采用A*算法初始化种群、设计路径适应度函数、对路径进行交叉、变异、选择操作;
在路径规划模块中,
采用A*算法初始化种群:随机选取起点坐标和终点坐标,并将起点坐标和终点坐标加入染色体编码中;在水下环境栅格地图模型中加入一个无障碍随机点作为目标点;利用A*算法分别建立起点坐标点到目标点以及目标点到终点坐标点的路径,在路径建立过程中避免障碍点和外围区域;将起点坐标点和终点坐标点连接起来,对路径节点一模一样的进行删除,最终生成一个路径集合;
设计路径适应度函数:对路径集合中的每个路径点进行采样,计算各个路径点到最近障碍点的距离,当该距离小于数值P时,路径的适应度增加;当该距离大于等于数值P时,路径的适应度减少,其中P大于等于水下环境栅格地图模型的栅格边长的一半;选取适应度最小的路径作为良好路径:Fitness(i)=ω1Length(p)+ω2Num
其中,Fitness(i)为适应度函数,Length(p)为路径长度,Num为路径上距离障碍点小于P的路径点数量;ω1,ω2为路径长度与靠近障碍路径点数量的比例系数,当ω1>ω2时,表示保障路径长度较短更为优先,当ω1<ω2时,表示远离障碍保障运行安全更为优先;
对路径进行交叉、变异操作:个体为路径,且一个个体就是一条路径,进行交叉、变异的操作,产生更多的子代个体;
交叉概率以Pc表示,交叉操作在路径规划中指将已搜索到的两条父代个体在相交的点进行交换,交换后保留较短路径,摒弃较长路径;在进行交叉操作后,子代个体的适应度低于父代个体的适应度;
变异概率以Pm表示,变异操作在路径规划中指将已搜索到的父代个体以概率Pm进行翻转,再结合交叉操作得到适应度更低的子代个体;
交叉概率和变异概率的自适应模型为:
其中,Pc和Pm分别为交叉概率和变异概率; 分别为每一代的最大交叉概率和最小交叉概率, 分别为每一代的最大变异概率和最小变异概率;f为每一代适应度函数值、favg为适应度函数平均值、fmax为适应度函数平均值的最大值、fmin为适应度函数平均值的最小值;
当个体的适应度低于适应度平均值时,个体的交叉变异概率保持最大值
当个体的适应度高于适应度平均值时,适应度越大,交叉变异概率越低;
对路径进行选择操作:选择父代种群中适应度最小的最精英个体作为良好路径,将良好路径保留下来用于与子代种群中的最精英个体相比较,若子代最精英个体的适应度小于良好路径的适应度,则将子代最精英个体更新为良好路径;否则,依然保留父代最精英个体为良好路径;
路径优化模块,用以采用Bezier优化算子对所述良好路径进行优化,得到最优路径;
控制模块,用以通过所述最优路径控制水下机器人进行搜救。
2.根据权利要求1所述的具备路径规划功能的搜救ROV控制系统,其特征在于:在水下环境栅格地图模型建立模块中,在水下环境栅格地图模型中,黑格表示障碍物,白格代表水下机器人的自由空间,使用序号标记法进行栅格标记,按照从左到右、从下到上的原则依次加1进行标记;在水下环境栅格地图模型中,S,2,3,…,E为栅格节点,每个栅格节点为一个路径点;其中,S为水下机器人起点位置,E为水下机器人终点位置;给定栅格序号T(i,j)与直角坐标点P(i,j)[X(i,j),Y(i,j)]的关系如下:其中,mod表示取模算法的行为,floor表示整数除法的行为。
3.根据权利要求1所述的具备路径规划功能的搜救ROV控制系统,其特征在于:在路径优化模块中,假定存在一条含有m个控制点P0,P1,P2,…,Pm的贝塞尔曲线,该曲线的数学表达式如下所示:T
其中,m∈N+,t为归一化时间变量,Pn=(xn,yn)为第n个控制点的坐标向量,xn和yn分别为X和Y坐标的分量, 为Bernstein多项式,是Bezier曲线表达式的基础函数,展开式为:使用上述贝塞尔曲线的数学表达式对良好路径进行优化,得到最优路径。
4.一种具备路径规划功能的搜救ROV控制方法,其特征在于,包括:
(1)通过水下机器人的工作环境构建水下环境栅格地图模型;
(2)通过采用改进的遗传算法对路径进行规划得到良好路径,改进的遗传算法对路径进行规划的过程为:采用A*算法初始化种群、设计路径适应度函数、对路径进行交叉、变异、选择操作;
采用A*算法初始化种群:随机选取起点坐标和终点坐标,并将起点坐标和终点坐标加入染色体编码中;在水下环境栅格地图模型中加入一个无障碍随机点作为目标点;利用A*算法分别建立起点坐标点到目标点以及目标点到终点坐标点的路径,在路径建立过程中避免障碍点和外围区域;将起点坐标点和终点坐标点连接起来,对路径节点一模一样的进行删除,最终生成一个路径集合;
设计路径适应度函数:对路径集合中的每个路径点进行采样,计算各个路径点到最近障碍点的距离,当该距离小于数值P时,路径的适应度增加;当该距离大于等于数值P时,路径的适应度减少,其中P大于等于水下环境栅格地图模型的栅格边长的一半;选取适应度最小的路径作为良好路径:Fitness(i)=ω1Length(p)+ω2Num
其中,Fitness(i)为适应度函数,Length(p)为路径长度,Num为路径上距离障碍点小于P的路径点数量;ω1,ω2为路径长度与靠近障碍路径点数量的比例系数,当ω1>ω2时,表示保障路径长度较短更为优先,当ω1<ω2时,表示远离障碍保障运行安全更为优先;
进行交叉、变异操作:个体为路径,且一个个体就是一条路径,进行交叉、变异的操作,产生更多的子代个体;
交叉概率以Pc表示,交叉操作在路径规划中指将已搜索到的两条父代个体在相交的点进行交换,交换后保留较短路径,摒弃较长路径;在进行交叉操作后,子代个体的适应度低于父代个体的适应度;
变异概率以Pm表示,变异操作在路径规划中指将已搜索到的父代个体以概率Pm进行翻转,再结合交叉操作得到适应度更低的子代个体;
交叉概率和变异概率的自适应模型为:
其中,Pc和Pm分别为交叉概率和变异概率; 为每一代的最大交叉概率和最小交叉概率, 为每一代的最大变异概率和最小变异概率;f,favg,fmax和fmin分别为每一代适应度函数值、适应度函数平均值、适应度函数平均值的最大值和适应度函数平均值的最小值;
当个体的适应度低于适应度平均值时,个体的交叉变异概率保持最大值
当个体的适应度高于适应度平均值时,适应度越大,交叉变异概率越低;
对路径进行选择操作:选择父代种群中适应度最小的最精英个体作为良好路径,将良好路径保留下来用于与子代种群中的最精英个体相比较,若子代最精英个体的适应度小于良好路径的适应度,则将子代最精英个体更新为良好路径;否则,依然保留父代最精英个体为良好路径;
(3)采用Bezier优化算子对所述良好路径进行优化,得到最优路径;
(4)通过所述最优路径控制水下机器人进行搜救。
5.根据权利要求4所述的具备路径规划功能的搜救ROV控制方法,其特征在于:在步骤(1)中,在水下环境栅格地图模型中,黑格表示障碍物,白格代表水下机器人的自由空间,使用序号标记法进行栅格标记,按照从左到右,从下到上的原则依次加1进行标记,在水下环境栅格地图模型中,S,2,3,…,E为栅格节点,每个栅格节点为一个路径点;其中,S为水下机器人起点位置,E为水下机器人终点位置;给定栅格序号T(i,j)与直角坐标点P(i,j)[X(i,j),Y(i,j)]的关系如下:其中,mod表示取模算法的行为,floor表示整数除法的行为。
6.根据权利要求4所述的具备路径规划功能的搜救ROV控制方法,其特征在于:在步骤(3)中,假定存在一条含有m个控制点P0,P1,P2,…,Pm的贝塞尔曲线,该曲线的数学表达式如下所示:T
其中,m∈N+,t为归一化时间变量,Pn=(xn,yn)为第n个控制点的坐标向量,xn和yn分别为X和Y坐标的分量, 为Bernstein多项式,是Bezier曲线表达式的基础函数,展开式为: 使用上述贝塞尔曲线的数学表达式对良好路径进行优化,得到最优路径。
7.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求4至6任一项所述方法的步骤。
8.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求4至6中任一项所述方法的步骤。