一种基于混合粒子群算法的无人船路径优化方法和系统与流程

技术特征：
1.一种基于混合粒子群算法的无人船路径优化方法，其特征在于，包括：步骤s1、基于无人船当前规划路径重新选择若干新路径点，其中所述当前规划路径包括若干段依次连接的路径段，每个所述新路径点均位于一个路径段上；步骤s2、以所有路径段中各所述新路径点依次相连后形成路径长度最小为第一目标函数，以各新路径点处的平滑度平均值最小为第二目标函数，以各新路径点距离障碍物的距离平均值最小为第三目标函数，构建适应度函数；步骤s3、以所述适应度函数确定混合粒子算法中各粒子的适应值，并基于模拟退火算法对各粒子的适应值进行迭代更新，保存各粒子最优值和粒子群最优值，确定所述适应度函数最小时每个所述链接线上的新路径点坐标。2.根据权利要求1所述的基于混合粒子群算法的无人船路径优化方法，其特征在于，所述步骤s1具体包括：基于dijkstra算法在链接图上搜索出的最优路径的路径点依次为p0,p1,p2,
…
,p
n
,p
n 1
.；其中，p0为起始点，p
n 1
.为目标点；路径点的链接线依次为l
i
(i＝1，2，
…
，n)；确定链接线l
i
所有点的表达式：p
i
(h
i
)＝p
i(0)
(p
i(1)-p
i(0)
)
×
h
i
上式中，h
i
为比例系数，h
i
∈[0,1]；d为链接线条数；和分别为链接线l
i
的两个端点。3.根据权利要求2所述的基于混合粒子群算法的无人船路径优化方法，其特征在于，所述步骤s2中，连接所有相邻链接线上新路径点后形成的路径长度为：述步骤s2中，连接所有相邻链接线上新路径点后形成的路径长度为：上式中，d
i
表示链接线l
i
上的新路径点p
i
与链接线l
i 1
上的新路径点p
i 1
之间的路径段长度；(x
i
,y
i
)为新路径点p
i
的坐标。4.根据权利要求3所述的基于混合粒子群算法的无人船路径优化方法，其特征在于，所述步骤s2中，每个新路径点处的拐角为：上式中，表示从新路径点p
i-1
到新路径点p
i
的向量，
│
p
i-1
p
i
│
表示向量的长度；所述步骤s3中，基于各新路径点处的拐角平均值确定路径平滑度为：上式中，k为惩罚系数，k取α
i
中大于或等于π/2的个数。5.根据权利要求4所述的基于混合粒子群算法的无人船路径优化方法，其特征在于，所述步骤s2中，新路径点与障碍物的最短距离为：
d
i
＝min{p
i
p
i(0)
,p
i
p
i(1)
}和分别为新路径点p
i
所在链接线的两个端点；所述步骤s3中，障碍物的距离平均值为：所述步骤s3中，所述路径安全性系数为：上式中，λ为权重调整系数，k为与障碍物最短距离为0的新路径点的个数。6.根据权利要求5所述的基于混合粒子群算法的无人船路径优化方法，其特征在于，所述步骤s3中，所述适应度函数为：fitv＝ω1*f1 ω2*f2 ω3*f3上式中，f1为所有相邻链接线上新路径点后形成的路径长度；f2为路径平滑度；f3为路径安全性系数；ω1、ω2、ω3分别为权重系数，ω1 ω2 ω3＝1。7.根据权利要求6所述的基于混合粒子群算法的无人船路径优化方法，其特征在于，所述步骤s3具体包括：步骤s31、初始化混合粒子群算法中的参数，并随机设置各个粒子的速度和位置；步骤s32、评价没个粒子的适应度，将粒子的位置和适应值保存在粒子的各自极值p
best
中，并将所有p
best
中的最优适应值的个体位置和适应值保存到全局极值g
best
中；步骤s33、确定初始温度t0；步骤s34、根据所述适应度函数确定当前温度下粒子p
i
的适应值；步骤s35、基于轮盘赌法从所有p
i
中确定全局最优值p
g
的替代者p’g
；步骤s36、更新各粒子的速度和位置；步骤s37、计算各粒子的适应值，并更新p
best
和g
best
，并进行退温操作；步骤s38、若判断达到预设停止条件，则停止搜索并输出粒子群最优值，否则返回步骤s34。8.一种基于混合粒子群算法的无人船路径优化系统，其特征在于，包括：路径规划模块，基于无人船当前规划路径重新选择若干新路径点，其中所述当前规划路径包括若干段依次连接的路径段，每个所述新路径点均位于一个路径段上；路径优化模块，以所有路径段中各所述新路径点依次相连后形成路径长度最小为第一目标函数，以各新路径点处的平滑度平均值最小为第二目标函数，以各新路径点距离障碍物的距离平均值最小为第三目标函数，构建适应度函数；混合粒子群求解模块，以所述适应度函数确定混合粒子算法中各粒子的适应值，并基于模拟退火算法对各粒子的适应值进行迭代更新，保存各粒子最优值和粒子群最优值，确定所述适应度函数最小时每个所述链接线上的新路径点坐标。9.一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述程序时实现如权利要求1至7任一项所述基于混合粒子群算法的无人船路径优化方法的步骤。
10.一种非暂态计算机可读存储介质，其上存储有计算机程序，其特征在于，该计算机程序被处理器执行时实现如权利要求1至7任一项所述基于混合粒子群算法的无人船路径优化方法的步骤。

技术总结
本发明实施例提供一种基于混合粒子群算法的无人船路径优化方法和系统，以无人船当前规划路径中各路径点为基础，同时考虑多点约束和规避障碍物等自然条件约束，重新进行路径点划分，综合考虑路径长度、路径平滑度和路径安全性，实现路径长度、路径平滑度和路径安全性的多目标优化，从而规划出一条符合无人船航行实际的全局路径。实际的全局路径。实际的全局路径。


技术研发人员：罗南杭 赵昆明 丁玮 胡芳禹 颜子杰
受保护的技术使用者：中国船舶重工集团公司第七一九研究所
技术研发日：2021.11.11
技术公布日：2022/1/11