1.本发明涉及
机器人路径规划及运动控制技术领域,具体为一种考虑多目标优化的消毒机器人路径规划方法。
背景技术:
2.医院、传染病集中地以及酒店宾馆等环境中容易堆积对人体有害的微生物,必须依据规范指引对环境进行消毒,使用消毒机器人能够较好的实现消毒作业,在现实中,会面临许多具有多个消毒目标的区域(如大型医院、传染病爆发区等),采用消毒机器人进行消毒可以最大程度上降低人类的危险;为了对具有多个消毒目标的区域进行勘察和消毒作业,消毒机器人必须具有多目标路径规划的能力,使消毒机器人能够规划一条覆盖区域内所有消毒目标的路径。
3.现有技术中,绝大多数的多目标路径规划方法,都假设机器人拥有足够的能量覆盖整个区域,来进行重复的迭代运行;然而,在运行过程中的路径长度、转动角度大小、能量消耗以及路径覆盖率等参数,都是消毒机器人在进行多目标路径规划时必须考虑的问题。
4.综上
所述,如何在考虑运行过程中的路径长度、转动角度大小、能量消耗以及路径覆盖率等参数的同时,为消毒机器人设计合理的多目标路径规划方法,成为亟待解决的问题。
技术实现要素:
5.本发明的目的在于提供一种考虑多目标优化的消毒机器人路径规划方法,能够在考虑消毒机器人的总行驶距离、总旋转角度、能量消耗总量以及消毒区域重合率的情况下,完成消毒机器人的多目标路径规划。
6.为实现上述目的,本发明提供如下技术方案:一种考虑多目标优化的消毒机器人路径规划方法,其包括下述步骤:
7.s1、将待规划区域的地图处理为改进的维诺图vm,以形成若干不重叠的多边形子区域,并获得所述维诺图vm的改进点集s;
8.s2、根据所述改进的维诺图vm和所述消毒机器人的形状,采用构型空间表示所述消毒机器人在所述待规划区域内的可行子区域so,并采用构型空间表示所述待规划区域内的障碍物子区域si;
9.s3、根据所述消毒机器人的多个消毒目标,规划所述消毒机器人的路径s,分别构建所述消毒机器人的路径代价
函数c1(s)、角度代价函数c2(s)、能量消耗代价函数c3(s)以及路径覆盖率代价函数c4(s),并求和或加权求和所述路径代价函数c1(s)、所述角度代价函数c2(s)、所述能量消耗代价函数c3(s)以及所述路径覆盖率代价函数c4(s),获得总代价函数c(x),且使用所述维诺图vm的改进点集s和所述可行子区域so来约束所述总代价函数c(x);
10.其中,所述路径代价函数c1(s)关于所述消毒机器人在消毒目标中以及各个消毒
目标间的总行驶距离,所述角度代价函数c2(s)关于所述消毒机器人在消毒目标中以及各个消毒目标间的总旋转角度,所述能量消耗代价函数c3(s)关于所述消毒机器人的能量消耗总量,所述路径覆盖率代价函数c4(s)关于所述消毒机器人的消毒区域重合率;
11.s4、将所述总代价函数c(x)结构化,并进一步构造学习型神经网络,以动态获取所述总代价函数c(x)最小的路径。
12.上述技术方案中,所述步骤s1具体包括:
13.s1.1、在待规划区域的地图上生成若干的随机点pi;
14.s1.2、以所述随机点pi的集合作为初始点集s0,生成改进的维诺图vm,以形成若干不重叠的多边形子区域;
15.s1.3、对所有的所述多边形子区域赋予权值wi,并利用所述权值wi改进所述初始点集s0,以获得所述维诺图vm的改进点集s={w1p1,w2p2,...,wnpn}。
16.上述技术方案中,所述步骤s2中的可行子区域so,具体为:
[0017][0018]
在构型空间下,pr为所述消毒机器人的质点,sr为全部点pr所构成的集合,sc为整个所述待规划区域的点集,sw为所述消毒机器人在所述待规划区域中的工作空间之点集,且sc=si+sw。
[0019]
上述技术方案中,所述步骤s3中的路径代价函数c1(s),具体为:
[0020][0021]
其中,li为所述消毒机器人从上一个消毒目标的结束点到当前消毒目标的起始点之间的行驶距离,dj为所述消毒机器人在第j个消毒目标中的行驶距离,q+1为消毒目标的总个数,q为li的总段数。
[0022]
上述技术方案中,所述步骤s3中的角度代价函数c2(s),具体为:
[0023][0024]
其中,(qi,q
i+1
)为路径s的序列点集,θ(qi,q
i+1
)为所述消毒机器人在qi与q
i+1
这两点之间的旋转角度,h为所述消毒机器人的总旋转次数。
[0025]
上述技术方案中,所述步骤s3中的能量消耗代价函数c3(s),具体为:
[0026][0027]
其中,e1为所述消毒机器人从上一个消毒目标的结束点到当前消毒目标的起始点之间的行驶过程中的能量消耗系数,e2为所述消毒机器人在消毒目标中的行驶及消毒过程中的能量消耗系数,e3为所述消毒机器人在旋转时的能量消耗系数。
[0028]
上述技术方案中,所述步骤s3中的路径覆盖率代价函数c4(s),具体为:
[0029][0030]
其中,p为消毒目标的点集,qi为所述消毒机器人的消毒范围的点集,da为消毒目标的微分。
[0031]
上述技术方案中,所述路径覆盖率代价函数c4(s)通过下述步骤简化:
[0032]
sa、定义所述维诺图vm的任意一个多边形子区域的质心为点g,则有:
[0033][0034][0035]
其中,g
x
为点g的x轴坐标,gy为点g的y轴坐标,na为所述维诺图vm中的顶点个数,ag为点g所在的多边形子区域的面积,且有:
[0036][0037]
sb、综合所述维诺图vm的所有多边形子区域,将所述路径覆盖率代价函数c4(s)简化为:
[0038][0039]
上述技术方案中,所述步骤s3中的总代价函数c(x),有:
[0040]
min c(x)=(c1(s),c2(s),c3(s),c4(s))。
[0041]
上述技术方案中,所述步骤s4具体包括:
[0042]
s4.1、利用马尔可夫决策过程,对所述消毒机器人的路径s进行迭代规划;
[0043]
在所述马尔可夫决策过程中,有:奖励函数r
t
=ci×ri
+bs×rc-μi×cu
;
[0044]
其中,ci为所述消毒机器人到达的维诺图vm之多边形子区域的奖励权值,ri为该个所述多边形子区域的奖励值;bs为所述马尔可夫决策过程结束时的奖励权值,rc为所述马尔可夫决策过程结束时的奖励值,μi为所述消毒机器人到达的维诺图vm之多边形子区域的惩罚权值,ci为该个所述多边形子区域的惩罚值;
[0045]
s4.2、构建一学习型神经网络,并使用所述学习型神经网络对所述消毒机器人的路径s迭代规划过程进行训练,使用经验缓冲区来记录所述消毒机器人在训练期间的状态、动作和奖励;
[0046]
所述学习型神经网络在点p处的激活函数为:
[0047][0048]
其中,p
x
为点p的x轴坐标,py为点p的y轴坐标,α为学习参量;
[0049]
s4.3、所述消毒机器人在训练期间,所述学习型神经网络的每一节点均使用边际值函数对策略梯度进行拟合;
[0050]
且,时间t的边际值函数gr关于参数τ、函数状态s
t
和响应ψ
t
的关系式为:
[0051][0052]
其中,为调节期望系数,w
t
为重要性权重系数,q
τ
(s
t
|ψ
t
)为回溯评估值,且
[0053]
其中,η
t
为马尔可夫决策过程中的奖励值,λ
t
为奖励系数,κ为权重因子;w
t+1
为t+1
时刻的动态调节权重,q(s
t+1
|ψ
t+1
)为t+1时刻的估计值,q
τ
(s
t+1
|ψ
t+1
)为t+1时刻的回溯评估值;
[0054]
s4.4、采用均方跟法对所述边际值函数gr进行优化,以将所述边际值函数gr的权值调整为如下关系式:
[0055]mt
=εm
t-1
+(1-ε)|g
t-1
|;
[0056][0057]wt+1
=w
t
+δw;
[0058]
其中,m
t
为所述边际值函数gr的指数平均数,g
t-1
为所述边际值函数gr在t-1时刻的梯度向量,ε和ρ均为调节参数,ξ为所述学习型神经网络的学习速率;w
t+1
为t+1时刻的动态调节权重,w
t
为t时刻的调节权重值,δw为t时刻的权值调节量。
[0059]
与现有技术相比,本发明的有益效果是:
[0060]
1、该种考虑多目标优化的消毒机器人路径规划方法,通过总代价函数c(x)的形式,在考虑消毒机器人的总行驶距离、总旋转角度、能量消耗总量以及消毒区域重合率的情况下,完成消毒机器人的多目标路径规划,并根据改进的维诺图vm和消毒机器人的形状获得可行子区域so,以约束总代价函数c(x),使消毒机器人的多目标路径规划过程快速准确。
[0061]
2、该种考虑多目标优化的消毒机器人路径规划方法,简化后的路径覆盖率代价函数c4(s),能够针对维诺图vm的所有多边形子区域来表示消毒机器人的消毒区域重合率,降低了计算总代价函数c(x)的最小值时的运算量。
[0062]
3、该种考虑多目标优化的消毒机器人路径规划方法,学习型神经网络自动化地通过马尔可夫决策过程对消毒机器人进行训练,通过有限次的马尔可夫决策过程迭代及训练,逐渐靠近奖励函数的最大值,并通过边际值函数gr及其优化方法,进一步靠近奖励函数的最大值并减少迭代及训练的次数,使消毒机器人的性能得以快速提高。
附图说明
[0063]
图1为本发明的实施例一的步骤流程图。
[0064]
图2为本发明的实施例一中的步骤s1的步骤流程图。
[0065]
图3为本发明的实施例一在步骤s1中所构建的维诺图vm的示意性视图。
[0066]
图4为本发明的消毒机器人在消毒目标中以及各个消毒目标间的运行示意图。
[0067]
图5为本发明的消毒机器人在消毒目标中的消毒范围示意图。
[0068]
图6为本发明的实施例二的步骤流程图。
[0069]
图7为本发明的实施例三的步骤流程图。
具体实施方式
[0070]
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
[0071]
实施例一:
[0072]
请参阅图1,本实施例提供一种考虑多目标优化的消毒机器人路径规划方法,其包括下述步骤:
[0073]
s1、将待规划区域的地图处理为改进的维诺图vm,以形成若干不重叠的多边形子区域,并获得维诺图vm的改进点集s。
[0074]
使用改进的维诺图vm和改进点集s,便于对消毒机器人的路径规划提供可量化及可计算的离散地图数据,简化了消毒机器人的路径规划过程。
[0075]
s2、根据改进的维诺图vm和消毒机器人的形状,采用构型空间表示消毒机器人在待规划区域内的可行子区域so,并采用构型空间表示待规划区域内的障碍物子区域si。
[0076]
可行子区域so即为消毒机器人的自由空间,在可行子区域so中,消毒机器人不与任何障碍物有交集;以此方式表示的可行子区域so中,可以忽略消毒机器人的形状影响,将消毒机器人视为质点,简化了消毒机器人的路径规划过程;后续的路径规划过程中,所规划的路径之点集从可行子区域so中获取。
[0077]
s3、根据消毒机器人的多个消毒目标,规划消毒机器人的路径s,分别构建消毒机器人的路径代价函数c1(s)、角度代价函数c2(s)、能量消耗代价函数c3(s)以及路径覆盖率代价函数c4(s),并求和或加权求和路径代价函数c1(s)、角度代价函数c2(s)、能量消耗代价函数c3(s)以及路径覆盖率代价函数c4(s),获得总代价函数c(x),且使用维诺图vm的改进点集s和可行子区域so来约束总代价函数c(x)。
[0078]
其中,路径代价函数c1(s)关于消毒机器人在消毒目标中以及各个消毒目标间的总行驶距离,角度代价函数c2(s)关于消毒机器人在消毒目标中以及各个消毒目标间的总旋转角度,能量消耗代价函数c3(s)关于消毒机器人的能量消耗总量,路径覆盖率代价函数c4(s)关于消毒机器人的消毒区域重合率。
[0079]
本步骤中,消毒目标是指分布在待规划区域中的若干个需要消毒的块状区域,各个消毒目标在待规划区域中相邻或相离,但不重合。
[0080]
根据总代价函数c(x),计算总代价函数c(x)的最小值获得条件,即可达到最优的多目标规划路径。
[0081]
s4、将总代价函数c(x)结构化,并进一步构造学习型神经网络,以动态获取总代价函数c(x)最小的路径。
[0082]
请参阅图2,具体地,步骤s1具体包括:
[0083]
s1.1、在待规划区域的地图上生成若干的随机点pi。
[0084]
实际上,随机点pi的生成与待规划区域的参数、消毒机器人的本身参数以及外界参数均无关。
[0085]
s1.2、以随机点pi的集合作为初始点集s0,生成改进的维诺图vm,以形成若干不重叠的多边形子区域。
[0086]
s1.3、对所有的多边形子区域赋予权值wi,并利用权值wi改进初始点集s0,以获得维诺图vm的改进点集s={w1p1,w2p2,...,wnpn}。
[0087]
请参阅图3,以此方式生成的维诺图vm具有如下的性质:
[0088][0089]
其中,pm和pn均为改进点集s中的任意点,p为维诺图vm上的任意点,该性质表明对
于每个超出维诺图vm边界的多边形子区域,在维诺图vm边界外的顶点将被替换为维诺图vm的边界或者顶点,从而能够正确地表示待规划区域。
[0090]
具体地,步骤s2中的可行子区域so,具体为:
[0091][0092]
在构型空间下,pr为消毒机器人的质点,sr为全部点pr所构成的集合,sc为整个待规划区域的点集,sw为消毒机器人在待规划区域中的工作空间之点集,且sc=si+sw。
[0093]
在点集sc中,考虑并抵消消毒机器人的全部质点pr所构成的集合sr后,在可行子区域so中,可以忽略消毒机器人的形状影响,将消毒机器人视为质点,简化了消毒机器人的路径规划过程。
[0094]
具体地,步骤s3中的路径代价函数c1(s),具体为:
[0095][0096]
请参阅图4,其中,li为消毒机器人从上一个消毒目标的结束点到当前消毒目标的起始点之间的行驶距离,i表示第i段的行驶距离;dj为消毒机器人在第j个消毒目标中的行驶距离,q+1为消毒目标的总个数,q为li的总段数。
[0097]
路径代价函数c1(s)能够准确的以离散数学模型的形式,表示消毒机器人在消毒目标中以及各个消毒目标间的总行驶距离,从而作为总代价函数c(x)的参数之一。
[0098]
具体地,步骤s3中的角度代价函数c2(s),具体为:
[0099][0100]
其中,(qi,q
i+1
)为路径s的序列点集,θ(qi,q
i+1
)为消毒机器人在qi与q
i+1
这两点之间的旋转角度,h为消毒机器人的总旋转次数。
[0101]
角度代价函数c2(s)能够准确的以离散数学模型的形式,表示消毒机器人在消毒目标中以及各个消毒目标间的总旋转角度,从而作为总代价函数c(x)的参数之一。
[0102]
具体地,步骤s3中的能量消耗代价函数c3(s),具体为:
[0103][0104]
其中,e1为消毒机器人从上一个消毒目标的结束点到当前消毒目标的起始点之间的行驶过程中的能量消耗系数,e2为消毒机器人在消毒目标中的行驶及消毒过程中的能量消耗系数,e3为消毒机器人在旋转时的能量消耗系数。
[0105]
能量消耗代价函数c3(s)能够准确的以离散数学模型的形式,表示消毒机器人的能量消耗总量,从而作为总代价函数c(x)的参数之一。
[0106]
具体地,步骤s3中的路径覆盖率代价函数c4(s),具体为:
[0107][0108]
其中,p为消毒目标的点集,qi为消毒机器人的消毒范围的点集,da为消毒目标的微分。
[0109]
请参阅图5,消毒机器人的消毒范围是指消毒机器人在空间中的某一点时,其能够
对环境进行消毒的有效作用范围,这与消毒机器人的动作机构及消毒机构的结构设计有关;消毒机器人在实际的消毒过程中会在消毒目标中来回行驶,在来回行驶的过程中,消毒机器人的消毒范围会有所重合,设计路径覆盖率代价函数c4(s)的目的在于,尽量缩小消毒机器人消毒过程中的消毒范围重合面积;路径覆盖率代价函数c4(s)能够准确的以离散数学模型的形式,表示消毒机器人的消毒区域重合率,从而作为总代价函数c(x)的参数之一。
[0110]
综上,步骤s3中的总代价函数c(x),有:
[0111]
minc(x)=(c1(s),c2(s),c3(s),c4(s))。
[0112]
根据总代价函数c(x),计算总代价函数c(x)的最小值获得条件,即可达到最优的多目标规划路径。
[0113]
该种考虑多目标优化的消毒机器人路径规划方法,通过总代价函数c(x)的形式,在考虑消毒机器人的总行驶距离、总旋转角度、能量消耗总量以及消毒区域重合率的情况下,完成消毒机器人的多目标路径规划,并根据改进的维诺图vm和消毒机器人的形状获得可行子区域so,以约束总代价函数c(x),使消毒机器人的多目标路径规划过程快速准确。
[0114]
实施例二:
[0115]
请参阅图6,本实施例提供一种考虑多目标优化的消毒机器人路径规划方法,在实施例一提供的考虑多目标优化的消毒机器人路径规划方法的基础上,还进一步包括:
[0116]
路径覆盖率代价函数c4(s)通过下述步骤简化:
[0117]
sa、定义维诺图vm的任意一个多边形子区域的质心为点g,则有:
[0118][0119][0120]
其中,g
x
为点g的x轴坐标,gy为点g的y轴坐标,na为维诺图vm中的顶点个数,ag为点g所在的多边形子区域的面积,且有:
[0121][0122]
在维诺图vm的任意一个多边形子区域中,使路径覆盖率代价函数c4(s)的获得最小值的点是点g,因此,有必要表示出点g的x轴坐标和y轴坐标,并计算维诺图vm的面积ag。
[0123]
sb、综合维诺图vm的所有多边形子区域,将路径覆盖率代价函数c4(s)简化为:
[0124][0125]
该种考虑多目标优化的消毒机器人路径规划方法,简化后的路径覆盖率代价函数c4(s),能够针对维诺图vm的所有多边形子区域来表示消毒机器人的消毒区域重合率,降低了计算总代价函数c(x)的最小值时的运算量。
[0126]
实施例三:
[0127]
请参阅图7,本实施例提供一种考虑多目标优化的消毒机器人路径规划方法,在实施例一提供的考虑多目标优化的消毒机器人路径规划方法的基础上,还进一步包括:
[0128]
步骤s4具体包括:
[0129]
s4.1、利用马尔可夫决策过程,对消毒机器人的路径s进行迭代规划;
[0130]
在马尔可夫决策过程中,有:奖励函数r
t
=ci×ri
+bs×rc-μi×cu
;
[0131]
其中,ci为消毒机器人到达的维诺图vm之三角形区域的奖励权值,ri为该个三角形区域的奖励值;bs为马尔可夫决策过程结束时的奖励权值,rc为马尔可夫决策过程结束时的奖励值,μi为消毒机器人到达的维诺图vm之三角形区域的惩罚权值,ci为该个三角形区域的惩罚值;
[0132]
s4.2、构建一学习型神经网络,并使用学习型神经网络对消毒机器人的路径s迭代规划过程进行训练,使用经验缓冲区来记录消毒机器人在训练期间的状态、动作和奖励;
[0133]
在马尔可夫决策过程中,有:
[0134]
学习型神经网络在点p处的激活函数为:
[0135][0136]
其中,p
x
为点p的x轴坐标,py为点p的y轴坐标,α为学习参量;
[0137]
s4.3、消毒机器人在训练期间,学习型神经网络的每一节点均使用边际值函数对策略梯度进行拟合;
[0138]
且,时间t的边际值函数gr关于参数τ、函数状态s
t
和响应ψ
t
的关系式为:
[0139][0140]
其中,为调节期望系数,w
t
为重要性权重系数,q
τ
(s
t
|ψ
t
)为回溯评估值,且
[0141]
其中,η
t
为马尔可夫决策过程中的奖励值,初始值选取为1;λ
t
为奖励系数,初始值选取为0.9;κ为权重因子,初始值选取为0.8;w
t+1
为t+1时刻的动态调节权重,q(s
t+1
|ψ
t+1
)为t+1时刻的估计值,q
τ
(s
t+1
|ψ
t+1
)为t+1时刻的回溯评估值;
[0142]
s4.4、采用均方跟法对边际值函数gr进行优化,以将边际值函数gr的权值调整为如下关系式:
[0143]mt
=εm
t-1
+(1-ε)|g
t-1
|;
[0144][0145]wt+1
=w
t
+δw;
[0146]
其中,m
t
为边际值函数gr的指数平均数,g
t-1
为边际值函数gr在t-1时刻的梯度向量,ε和ρ均为调节参数,ξ为学习型神经网络的学习速率,初始值选取为0.8;w
t+1
为t+1时刻的动态调节权重,w
t
为t时刻的调节权重值,δw为t时刻的权值调节量。
[0147]
该种考虑多目标优化的消毒机器人路径规划方法,学习型神经网络自动化地通过马尔可夫决策过程对消毒机器人进行训练,通过有限次的马尔可夫决策过程迭代及训练,逐渐靠近奖励函数的最大值,并通过边际值函数gr及其优化方法,进一步靠近奖励函数的最大值并减少迭代及训练的次数,使消毒机器人的性能得以快速提高。
[0148]
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
技术特征:
1.一种考虑多目标优化的消毒机器人路径规划方法,其特征在于,包括下述步骤:s1、将待规划区域的地图处理为改进的维诺图v
m
,以形成若干不重叠的多边形子区域,并获得所述维诺图v
m
的改进点集s;s2、根据所述改进的维诺图v
m
和所述消毒机器人的形状,采用构型空间表示所述消毒机器人在所述待规划区域内的可行子区域s
o
,并采用构型空间表示所述待规划区域内的障碍物子区域s
i
;s3、根据所述消毒机器人的多个消毒目标,规划所述消毒机器人的路径s,分别构建所述消毒机器人的路径代价函数c1(s)、角度代价函数c2(s)、能量消耗代价函数c3(s)以及路径覆盖率代价函数c4(s),并求和或加权求和所述路径代价函数c1(s)、所述角度代价函数c2(s)、所述能量消耗代价函数c3(s)以及所述路径覆盖率代价函数c4(s),获得总代价函数c(x),且使用所述维诺图v
m
的改进点集s和所述可行子区域s
o
来约束所述总代价函数c(x);其中,所述路径代价函数c1(s)关于所述消毒机器人在消毒目标中以及各个消毒目标间的总行驶距离,所述角度代价函数c2(s)关于所述消毒机器人在消毒目标中以及各个消毒目标间的总旋转角度,所述能量消耗代价函数c3(s)关于所述消毒机器人的能量消耗总量,所述路径覆盖率代价函数c4(s)关于所述消毒机器人的消毒区域重合率;s4、将所述总代价函数c(x)结构化,并进一步构造学习型神经网络,以动态获取所述总代价函数c(x)最小的路径。2.根据权利要求1所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所述步骤s1具体包括:s1.1、在待规划区域的地图上生成若干的随机点p
i
;s1.2、以所述随机点p
i
的集合作为初始点集s0,生成改进的维诺图v
m
,以形成若干不重叠的多边形子区域;s1.3、对所有的所述多边形子区域赋予权值w
i
,并利用所述权值w
i
改进所述初始点集s0,以获得所述维诺图v
m
的改进点集s={w1p1,w2p2,...,w
n
p
n
}。3.根据权利要求2所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所述步骤s2中的可行子区域s
o
,具体为:在构型空间下,p
r
为所述消毒机器人的质点,s
r
为全部点p
r
所构成的集合,s
c
为整个所述待规划区域的点集,s
w
为所述消毒机器人在所述待规划区域中的工作空间之点集,且sc=s
i
+s
w
。4.根据权利要求1所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所述步骤s3中的路径代价函数c1(s),具体为:其中,l
i
为所述消毒机器人从上一个消毒目标的结束点到当前消毒目标的起始点之间的行驶距离,d
j
为所述消毒机器人在第j个消毒目标中的行驶距离,q+1为消毒目标的总个数,q为l
i
的总段数。5.根据权利要求4所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所
述步骤s3中的角度代价函数c2(s),具体为:其中,(q
i
,q
i+1
)为路径s的序列点集,θ(q
i
,q
i+1
)为所述消毒机器人在q
i
与q
i+1
这两点之间的旋转角度,h为所述消毒机器人的总旋转次数。6.根据权利要求5所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所述步骤s3中的能量消耗代价函数c3(s),具体为:其中,e1为所述消毒机器人从上一个消毒目标的结束点到当前消毒目标的起始点之间的行驶过程中的能量消耗系数,e2为所述消毒机器人在消毒目标中的行驶及消毒过程中的能量消耗系数,e3为所述消毒机器人在旋转时的能量消耗系数。7.根据权利要求6所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所述步骤s3中的路径覆盖率代价函数c4(s),具体为:其中,p为消毒目标的点集,q
i
为所述消毒机器人的消毒范围的点集,da为消毒目标的微分。8.根据权利要求7所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所述路径覆盖率代价函数c4(s)通过下述步骤简化:sa、定义所述维诺图v
m
的任意一个多边形子区域的质心为点g,则有:的任意一个多边形子区域的质心为点g,则有:其中,g
x
为点g的x轴坐标,g
y
为点g的y轴坐标,n
a
为所述维诺图v
m
中的顶点个数,a
g
为点g所在的多边形子区域的面积,且有:sb、综合所述维诺图v
m
的所有多边形子区域,将所述路径覆盖率代价函数c4(s)简化为:9.根据权利要求8所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所述步骤s3中的总代价函数c(x),有:minc(x)=(c1(s),c2(s),c3(s),c4(s))。10.根据权利要求1所述的考虑多目标优化的消毒机器人路径规划方法,其特征在于,所述步骤s4具体包括:s4.1、利用马尔可夫决策过程,对所述消毒机器人的路径s进行迭代规划;
在所述马尔可夫决策过程中,有:奖励函数r
t
=c
i
×
r
i
+b
s
×
r
c-μ
i
×
c
u
;其中,c
i
为所述消毒机器人到达的维诺图v
m
之多边形子区域的奖励权值,r
i
为该个所述多边形子区域的奖励值;b
s
为所述马尔可夫决策过程结束时的奖励权值,r
c
为所述马尔可夫决策过程结束时的奖励值,μ
i
为所述消毒机器人到达的维诺图v
m
之多边形子区域的惩罚权值,c
i
为该个所述多边形子区域的惩罚值;s4.2、构建一学习型神经网络,并使用所述学习型神经网络对所述消毒机器人的路径s迭代规划过程进行训练,使用经验缓冲区来记录所述消毒机器人在训练期间的状态、动作和奖励;所述学习型神经网络在点p处的激活函数为:其中,p
x
为点p的x轴坐标,p
y
为点p的y轴坐标,α为学习参量;s4.3、所述消毒机器人在训练期间,所述学习型神经网络的每一节点均使用边际值函数对策略梯度进行拟合;且,时间t的边际值函数g
r
关于参数τ、函数状态s
t
和响应ψ
t
的关系式为:其中,为调节期望系数,w
t
为重要性权重系数,q
τ
(s
t
|ψ
t
)为回溯评估值,且其中,η
t
为马尔可夫决策过程中的奖励值,λ
t
为奖励系数,κ为权重因子;w
t+1
为t+1时刻的动态调节权重,q(s
t+1
|ψ
t+1
)为t+1时刻的估计值,q
τ
(s
t+1
|ψ
t+1
)为t+1时刻的回溯评估值;s4.4、采用均方跟法对所述边际值函数g
r
进行优化,以将所述边际值函数g
r
的权值调整为如下关系式:m
t
=εm
t-1
+(1-ε)|g
t-1
|;w
t+1
=w
t
+δw;其中,m
t
为所述边际值函数g
r
的指数平均数,g
t-1
为所述边际值函数g
r
在t-1时刻的梯度向量,ε和ρ均为调节参数,ξ为所述学习型神经网络的学习速率;w
t+1
为t+1时刻的动态调节权重,w
t
为t时刻的调节权重值,δw为t时刻的权值调节量。
技术总结
本发明公开一种考虑多目标优化的消毒机器人路径规划方法,包括获得维诺图V
技术研发人员:
蒋立青 蒋立宇 王欢 涂文章 董建华 刘超 蒋祥兵 朱陈燕 罗佩
受保护的技术使用者:
武汉市肺科医院
技术研发日:
2022.06.22
技术公布日:
2022/10/11