无人水下航行器群体任务协调系统及方法
【专利摘要】本发明公开了一种无人水下航行器群体任务协调系统及方法。包括传感器模块、全局状态模块、任务协调模块和UUV执行器，传感器模块用于采集环境信息、UUV自身状态信息并接收其他UUV发送的信息；全局状态模块包括更新单元、UUV描述单元、任务描述单元，UUV描述单元进行UUV状态的更新，任务描述单元进行任务状态的更新；任务协调模块包括不可预见情况和冲突单元、动态任务规划单元、任务分配单元、组合体维护单元、执行单元，用于任务的协调与分配。本发明是一个分布式、高效、稳定的多无人水下航行器任务协调系统与方法。
【专利说明】无人水下航行器群体任务协调系统及方法
【技术领域】
[0001]本发明属于无人水下航行器领域，尤其涉及一种无人水下航行器群体任务协调系统及方法。
【背景技术】
[0002]无人水下航行器(UUV)最早出现于20世纪60年代。最初主要用于进行深水勘探、沉船打捞、水下电缆铺设及维修等民用领域。
[0003]无人水下航行器群体(UUVs)是指由多个无人水下航行器组成的一个群体，群体中的每个个体通过相互之间的协作共同完成特定的作业任务。UUVs可以胜任单个UUV无法完成的任务。UUVs中的不同个体可以搭载不同的探测设备，从而收集更多不同类型的探测数据，为完成包含不同类型子任务的任务提供更为完善的支持。其次，携带低精度探测设备的一组小型化、低造价UUVs凭借其空间分布上的优势，可以比携带高精度但却极为昂贵探测设备的单个UUV更高效的完成任务。再次，由于UUVs自身存在的冗余特性，使得单个UUV的失效并不影响整个任务正常的实施，保证了任务完成的可靠性。故UUVs凭借其结构上的特性，可以很大程度上提高工作效率并保证任务的完成。随着技术的不断进步，UUVs的研究逐渐被各国所重视，而UUV之间的任务协调更是UUVs研究领域的重要组成部分，通过UUV之间的任务协调，不仅能发挥个体UUV的最大效能，也能保证任务高效、顺利的完成。该项技术的研究对于提高UUVs的智能化水平以及加速其在相关领域的应用中具有积极的理论意义和实用价值。
[0004]UUV的水下自主作业在某种程度上比无人机和无人车的自主作业更具有挑战性。尤其是在水下通信受限的情况下，所以UUV之间的协同控制更为困难。在传统的控制方式中，一般是在任务初始阶段使用一个中央规划器将任务分配给每个UUV，但是当出现由于外界环境或是UUV自身条件所致的任务执行期间的失败时，这种初始任务分配方式就变得不可用。因此，外界和自身状态的变化制约着这种任务分配方式的有效性。另外当前的基于市场机制的任务协调机制不能很好的在任务执行期间进行任务的重规划、任务重分解、重调度以及任务执行中的UUV的协调，并且对于单次规划仍存在效率低，鲁棒性差的问题。
【发明内容】
[0005]本发明的目的是提供一种高效的、稳定的并能对不可预见情况快速响应处理的无人水下航行器群体任务协调系统，本发明的目的还包括提供一种能够动态实现实时任务规划的无人水下航行器群体任务协调方法。
[0006]本发明是通过以下技术方案实现的:
[0007]无人水下航行器群体任务协调系统，包括传感器模块、全局状态模块、任务协调模块和UUV执行器，
[0008]传感器模块用于采集环境信息、UUV自身状态信息并接收其他UUV发送的信息；
[0009]全局状态模块包括更新单元、UUV描述单元、任务描述单元，更新单元用于分析采集环境信息、UUV自身状态信息并接收其他UUV发送的信息，UUV描述单元进行UUV状态的更新，任务描述单元进行任务状态的更新；
[0010]任务协调模块包括不可预见情况和冲突单元、动态任务规划单元、任务分配单元、组合体维护单元、执行单元，不可预见情况和冲突单元进行不可预见情况和冲突情况的检测与处理，当出现不可预见情况和冲突情况时，广播检测到的信息并使用预置的措施进行处理；动态任务规划单元对所有未完成任务进行重新规划并划分子任务；任务分配单元从子任务中选择一个候选任务，对候选任务执行拍卖，根据其他UUV向任务分配单元发送竞拍信息将子任务进行分配；组合体维护单元用于对组合体成员的更新；执行单元驱动UUV执行器运行任务。
[0011]本发明无人水下航行器群体任务协调方法，传感器模块采集环境信息、UUV自身状态信息并接收其他UUV发送的信息，传送给更新单元；
[0012]更新单元分析接收的信息后将结果传送给UUV描述单元和任务描述单元；
[0013]UUV描述单元根据接收的信息进行UUV状态的更新，将更新后的UUV状态信息分别传送给动态任务规划单元、不可预见情况和冲突单元；
[0014]任务描述单元根据接收的信息进行任务状态的更新，将更新后的任务状态信息分别传送给动态任务规划单元、不可预见情况和冲突单元；
[0015]不可预见情况和冲突单元接收UUV状态信息、任务状态信息和其他UUV发送的信息，执行不可预见情况和冲突的检测，当检测到不可预见情况和冲突时，广播警告信息并使用预置的预防措施进行处理；
[0016]动态任务规划单元根据接收的UUV状态信息、任务状态信息，通过构建未完成任务优先队列执行任务规划，并划分子任务，将结果传送给任务分配单元；
[0017]任务分配单元从子任务中选择一个候选任务，使用基于合同网的拍卖机制对候选任务执行拍卖，根据其他UUV向任务分配单元发送竞拍信息将子任务进行分配，将结果传送给组合体维护单元，并且广播任务分配；
[0018]组合体维护单元根据子任务分配信息对执行任务的组合体成员更新；
[0019]执行单元根据得到的任务驱动UUV执行器运行任务，广播任务执行信息。
[0020]本发明无人水下航行器群体任务协调方法，还可以包括:
[0021 ] 1、UUV描述单元输出的UUV状态信息为:
[0022]<u_id, u_cap, u_relinfo, u_stat>
[0023]其中u_id表示UUV唯一标识,u_cap表示UUV的能力，u_relinfo表示UUV的其它相关?目息，u_stat表不UUV的当如状态，分别有:
[0024]〈idle, excuting, failed, auct1nning)
[0025]idle表示空闲状态，excuting表示正在执行任务中，failed表示任务失败、auct1nning表示正在拍卖。
[0026]2、任务描述单元输出的任务状态信息为:
[0027]<t_id, t_reqcap, t_reqno, t_relinfo, t_stat>
[0028] 其中t_id表示任务唯一标识，t_reqcap表示执行此任务所需能力，t_reqno表示执行此任务需要的最少UUV数量,t_relinfo表示任务的相关信息,t_stat表示任务的当前状态，分别有:
[0029]〈unachieved, auct1ned, being_excuted, achieved, uncertain)
[0030]unachieved表示任务未完成未拍卖、auct1ned表示未完成已拍卖、being_excuted表示正在执行、achieved表示已经完成、uncertain表示状态不确定。
[0031]3、不可预见情况和冲突单元中的预先定义的预防措施为:
[0032]a、当检测到未知UUV的信息时，与未知UUV建立通信，收集未知UUV的信息在UUV描述单元更新UUV状态信息，
[0033]b、当检测到未知任务信息时，收集未知任务信息在任务描述单元更新任务状态信息，并加入到未完成任务队列中，
[0034]C、当检测到一个已经完成的任务又以新任务、正在执行、或正在拍卖的状态被发布时，向发布该任务的UUV发送警告信息，
[0035]d、当检测到正在执行任务的UUV收到当前任务的取消信息时，取消任务的执行，在UUV描述单元更新自身状态。
[0036]4、动态任务规划单元构建的任务优先队列的顺序是根据UUV到任务点Wi的相对距离relDist (Uj, Wi)由低到高排序，当前UUV由Uj表示，UUV到任务点的相对距离为:
【权利要求】
1.无人水下航行器群体任务协调系统，其特征在于:包括传感器模块、全局状态模块、任 务协调模块和UUV执行器， 传感器模块用于采集环境信息、UUV自身状态信息并接收其他UUV发送的信息； 全局状态模块包括更新单元、UUV描述单元、任务描述单元，更新单元用于分析采集环境信息、UUV自身状态信息并接收其他UUV发送的信息，UUV描述单元进行UUV状态的更新，任务描述单元进行任务状态的更新； 任务协调模块包括不可预见情况和冲突单元、动态任务规划单元、任务分配单元、组合体维护单元、执行单元，不可预见情况和冲突单元进行不可预见情况和冲突情况的检测与处理，当出现不可预见情况和冲突情况时，广播检测到的信息并使用预置的措施进行处理；动态任务规划单元对所有未完成任务进行重新规划并划分子任务；任务分配单元从子任务中选择一个候选任务，对候选任务执行拍卖，根据其他UUV向任务分配单兀发送竞拍信息将子任务进行分配；组合体维护单元用于对组合体成员的更新；执行单元驱动UUV执行器运行任务。
2.基于权利要求1所述的无人水下航行器群体任务协调系统的任务协调方法，其特征在于: 传感器模块采集环境信 息、UUV自身状态信息并接收其他UUV发送的信息，传送给更新单元； 更新单元分析接收的信息后将结果传送给UUV描述单元和任务描述单元； UUV描述单元根据接收的信息进行UUV状态的更新，将更新后的UUV状态信息分别传送给动态任务规划单元、不可预见情况和冲突单元； 任务描述单元根据接收的信息进行任务状态的更新，将更新后的任务状态信息分别传送给动态任务规划单元、不可预见情况和冲突单元； 不可预见情况和冲突单元接收UUV状态信息、任务状态信息和其他UUV发送的信息，执行不可预见情况和冲突的检测，当检测到不可预见情况和冲突时，广播警告信息并使用预置的预防措施进行处理； 动态任务规划单元根据接收的UUV状态信息、任务状态信息，通过构建未完成任务优先队列执行任务规划，并划分子任务，将结果传送给任务分配单元； 任务分配单元从子任务中选择一个候选任务，使用基于合同网的拍卖机制对候选任务执行拍卖，根据其他UUV向任务分配单元发送竞拍信息将子任务进行分配，将结果传送给组合体维护单元，并且广播任务分配； 组合体维护单元根据子任务分配信息对执行任务的组合体成员更新； 执行单元根据得到的任务驱动UUV执行器运行任务，广播任务执行信息。
3.根据权利要求2所述的无人水下航行器群体任务协调方法，其特征在于:所述的UUV描 述单元输出的UUV状态信息为:
〈U—id，u—cap，u—relinfo，u_stat> 其中u—id表示UUV唯一标识，u—cap表示UUV的能力，u—relinfo表示UUV的其它相关信息，u—Stat表示UUV的当前状态，分别有:〈idle, excuting, failed, auct1nning> idle表示空闲状态，excuting表示正在执行任务中，failed表示任务失败、auct1nning表示正在拍卖。
4.根据权利要求3所述的无人水下航行器群体任务协调方法，其特征在于:所述的任务描述单元输出的任务状态信息为:
<t_id, t_reqcap, t_reqno, t_relinfo, t_stat> 其中t_id表示任务唯一标识，t_reqcap表示执行此任务所需能力，t_reqno表示执行此任务需要的最少UUV数量，t _relinfo表示任务的相关信息，t_stat表示任务的当前状态，分别有:
〈unachieved, auct1ned, being_excuted, achieved, uncertain) unachieved表示任务未完成未拍卖、auct1ned表示未完成已拍卖、being_excuted表示正在执行、achieved表示已经完成、uncertain表示状态不确定。
5.根据权利要求4所述的无人水下航行器群体任务协调方法，其特征在于:所述的不可预见情况和冲突单元中的预先定义的预防措施为: a、当检测到未知UUV的信息时，与未知UUV建立通信，收集未知UUV的信息在UUV描述单元更新UUV状态信息， b、当检测到未知任务信息时，收集未知任务信息在任务描述单元更新任务状态信息，并加入到未完成任务队列中， C、当检测到一个已经完成的任务又以新任务、正在执行、或正在拍卖的状态被发布时，向发布该任务的UUV发送警告信息， d、当检测到正在执行任务的UUV收到当前任务的取消信息时，取消任务的执行，在UUV描述单元更新自身状态。
6.根据权利要求5所述的无人水下航行器群体任务协调方法，其特征在于:所述的动态任务规划单元构建的任务优先队列的顺序是根据UUV到任务点Wi的相对距离relDist (Uj, Wi)由低到高排序，当前UUV由Uj表示，UUV到任务点的相对距离为:
其中dist(Uj，Wi)表示UUV，Uj到任务点~的欧几里得距离
表示所有除+外的其它UUV到任务点Wi的距离最小值，并根据relDist (Uj, Wi)值将任务执行区域划分为子区域，也就是将任务M划分为η子任务M1, M2,…，Mi,…，Mn，其中η为执行此任务的UUV的数量。
7.根据权利要求6所述的无人水下航行器群体任务协调方法，其特征在于:所述的任务分配单元中其他UUV向任务分配单元发送竞拍信息为该UUV执行拍卖任务的代价，当前UUV执行执行子任务I的代价为:
其中q为子任务Wj中含有任务点的个数，而Uj执行任务点Wi的代价Cji为:
Cji = a *dist (Uj，Wi) + (1- α ) * [dist (wflJ wf2) -max (dist (Wi, wfl)，dist (Wi, wf2))]dist (wfl, wf2) = max (dist (Wi, Wj)), Wi, Wj e Mj 其中Wfl和Wf2为子任务％中相距最远的两个任务点，常量α作为调整因子； 其他UUV执行子任务^的代价为Cw，若Cw小于(^，那么当前UUV将任务分配给其他UUV,其他UUV由Uk表示，否则当前UUV执行子任务Wp对于其他UUV满足的条件为:
其中C/ = IJiIi，P为UUV总数。
【文档编号】G05B19/418GK104076800SQ201410326343
【公开日】2014年10月1日 申请日期:2014年7月10日 优先权日:2014年7月10日
【发明者】王宏健, 杨海智, 么洪飞, 吕洪莉 申请人:哈尔滨工程大学