一种多无人拖船编队补偿拖曳控制方法及系统

摘要: 本发明涉及无人船协同控制,特别是一种多无人拖船编队补偿拖曳控制方法及系统。背景技术:1、在港口大型浮体移泊、失效船舶救援、海洋工程装备调遣、浮式平台模块转运以及...
一种多无人拖船编队补偿拖曳控制方法及系统

本发明涉及无人船协同控制,特别是一种多无人拖船编队补偿拖曳控制方法及系统。

背景技术:

1、在港口大型浮体移泊、失效船舶救援、海洋工程装备调遣、浮式平台模块转运以及非驱动漂浮物应急处置等场景中,常需要多艘拖船通过拖缆协同牵引非驱动漂浮物。相较于单拖船拖曳,多无人拖船协同拖曳能够提升操纵冗余度和作业灵活性,但也带来了多拖船协同、拖缆力传递、被拖物体姿态控制以及环境扰动抑制等问题。

2、现有一类方案通常先根据被拖物体轨迹误差计算被拖物体所需的全部总控制力,再将该总控制力分配为各拖缆张力,随后由张力和拖缆模型反向推演各拖船的期望位姿。该类方案能够形成完整的“总控制力—张力—拖船位姿”闭环,但其拖船期望位姿主要由张力分配结果驱动,控制链条较长;当张力分配、拖缆模型或海况扰动存在偏差时,拖船目标位姿可能随张力求解结果产生较大变化,从而影响多拖船几何时变编队稳定性和被拖物体轨迹跟踪性能。

3、另一类多智能体编队控制方法通常设置虚拟领导者或虚拟编队中心,由多艘拖船围绕虚拟中心形成队形。然而,在多无人拖船拖曳非驱动漂浮物时,实际被控对象是非驱动漂浮物的轨迹和姿态,而不是单独的虚拟中心轨迹。若引入中间虚拟编队中心,容易使拖船编队轨迹与被拖物体真实运动之间产生额外转换误差。

技术实现思路

1、本发明所要解决的技术问题是针对现有技术的不足,提供一种多无人拖船编队补偿拖曳控制方法,以非驱动漂浮物的参考轨迹和拖缆附着几何关系为依据,直接生成无人拖船的基准期望轨迹,使各无人拖船先形成几何时变编队基础拖曳;在无人拖船跟踪基准期望轨迹的过程中,无人拖船推进器维持相对几何位置,拖缆被拉紧后产生水平张力,水平张力经由拖缆作用方向和拖点力臂构成的几何映射关系转化为作用在非驱动漂浮物上的纵向力、横向力和艏摇力矩;随后基于拖曳系统动力学模型获得非驱动漂浮物位姿响应,并根据基础拖曳后仍然存在的残余跟踪误差构造鲁棒控制器,生成补偿广义力,再通过拖缆水平张力分配得到各拖缆的期望水平张力,从而提高多无人拖船协同拖曳过程中的轨迹跟踪稳定性和抗扰能力。

2、本发明所要解决的另一个技术问题是提供了用于执行上述多无人拖船编队补偿拖曳控制方法的系统。

3、本发明所要解决的技术问题是通过以下的技术方案来实现的。本发明是一种多无人拖船编队补偿拖曳控制方法,该方法包括以下步骤:

4、(1)基于非驱动漂浮物、艘无人拖船以及根拖缆构建多拖船拖曳系统,其中,所述非驱动漂浮物为被拖物体,为大于等于3的整数,每艘无人拖船通过一根对应拖缆与所述非驱动漂浮物连接,并对所述非驱动漂浮物进行协同拖曳;

5、(2)获取所述非驱动漂浮物的参考轨迹、实时位姿和速度,各无人拖船的实时位姿和速度,各拖缆的拖点坐标、拖缆参数、拖缆作用方向以及拖船推进能力参数;

6、(3)基于所述非驱动漂浮物的参考轨迹,以及所述非驱动漂浮物、拖缆和无人拖船之间的拖缆附着几何关系,确定各无人拖船相对于所述非驱动漂浮物的时变相对偏移量;

7、(4)基于所述非驱动漂浮物的参考轨迹和所述时变相对偏移量,在不设置虚拟编队中心的条件下,直接生成各无人拖船的基准期望轨迹;

8、(5)基于各无人拖船的基准期望轨迹,控制各无人拖船跟踪对应的基准期望轨迹,使各无人拖船在所述多拖船拖曳系统中维持相对于所述非驱动漂浮物的几何时变编队,并通过拖缆形成预定的拖缆作用方向和水平距离;

9、(6)基于拖缆非线性模型和拖缆附着几何关系,将各拖缆的水平张力映射为作用于所述非驱动漂浮物的广义拖曳力,并通过拖曳系统动力学模型获得所述非驱动漂浮物的位姿响应和残余跟踪误差;

10、(7)基于所述残余跟踪误差,构造用于稳定所述残余跟踪误差的鲁棒控制器,并将所述鲁棒控制器输出的广义控制力作为补偿广义力,建立拖缆水平张力与所述补偿广义力之间的力分配映射关系;

11、(8)基于拖缆水平张力上下限约束,求解各拖缆的水平张力,并根据分配得到的拖缆水平张力形成拖缆期望水平张力指令,或修正各无人拖船的基准期望轨迹或基准控制输入;

12、(9)基于所述拖缆期望水平张力指令、修正后的基准期望轨迹或修正后的基准控制输入,控制各无人拖船运动,以在几何时变编队基础拖曳作用下,对所述非驱动漂浮物的残余跟踪误差进行力分配补偿。

13、本发明所要解决的技术问题还可以通过以下的技术方案来进一步实现,对于以上所述的多无人拖船编队补偿拖曳控制方法,所述艘无人拖船的期望轨迹基于所述非驱动漂浮物的参考轨迹、拖缆附着几何关系以及各无人拖船相对于所述非驱动漂浮物的时变相对偏移量直接生成,第艘无人拖船的期望位姿为:

14、

15、其中,为第艘无人拖船的期望位姿,为所述非驱动漂浮物的参考位姿,为第艘无人拖船相对于所述非驱动漂浮物的时变相对偏移量。

16、本发明所要解决的技术问题还可以通过以下的技术方案来进一步实现,对于以上所述的多无人拖船编队补偿拖曳控制方法,在所述多拖船拖曳系统中,第艘无人拖船的运动学和动力学模型采用如下形式:

17、

18、其中,下标,表示第艘无人拖船,为第艘无人拖船的位姿向量,为速度向量,为坐标变换矩阵,为惯性矩阵,为时变环境扰动,为第艘无人拖船推进器产生的控制力和力矩,为第根拖缆作用于第艘无人拖船的拖缆力;

19、非驱动漂浮物的运动学和动力学模型采用如下形式:

20、

21、其中,下标表示非驱动漂浮物,为所述非驱动漂浮物的位姿向量,为速度向量,为由所述非驱动漂浮物艏向角确定的坐标变换矩阵,为直接作用于所述非驱动漂浮物的推进力和力矩,为各拖缆作用于所述非驱动漂浮物的合成拖缆力;当所述非驱动漂浮物不具备执行器时,满足。

22、本发明所要解决的技术问题还可以通过以下的技术方案来进一步实现,对于以上所述的多无人拖船编队补偿拖曳控制方法,基于拖缆附着几何关系,将各拖缆水平张力映射为作用于所述非驱动漂浮物的合成拖缆力,满足:

23、

24、其中,为各拖缆水平张力向量,为拖缆力几何映射矩阵;

25、拖缆力几何映射矩阵由各拖缆作用方向角和各拖缆在非驱动漂浮物上的拖点坐标确定,当所述多拖船拖曳系统包括4艘无人拖船和4根拖缆时,所述拖缆力几何映射矩阵为:

26、

27、其中,为第根拖缆的作用方向角,为第根拖缆在所述非驱动漂浮物上的拖点坐标。

28、本发明所要解决的技术问题还可以通过以下的技术方案来进一步实现,对于以上所述的多无人拖船编队补偿拖曳控制方法,各拖缆的水平张力通过求解由拖缆两端水平距离和拖缆参数确定的非线性悬链线模型获得,满足:

29、

30、其中,为第根拖缆的水平张力,为拖缆两端水平距离,为拖缆长度,为拖缆单位长度重量,为杨氏模量,为拖缆横截面面积。

31、本发明所要解决的技术问题还可以通过以下的技术方案来进一步实现,对于以上所述的多无人拖船编队补偿拖曳控制方法,所述残余跟踪误差包括所述非驱动漂浮物的位姿误差和速度误差,满足:

32、

33、其中,为位姿误差,为速度误差,为所述非驱动漂浮物的参考位姿,为滤波后的虚拟控制量;

34、基于所述残余跟踪误差构造用于稳定残余跟踪误差的鲁棒控制器,并将所述鲁棒控制器的输出作为补偿广义力,满足:

35、

36、其中,为虚拟控制律,为滤波后的虚拟控制量,为所述鲁棒控制器输出的补偿广义力,和为正定增益矩阵。

37、本发明所要解决的技术问题还可以通过以下的技术方案来进一步实现,对于以上所述的多无人拖船编队补偿拖曳控制方法,基于所述鲁棒控制器输出的补偿广义力,建立拖缆水平张力与所述补偿广义力之间的力分配优化模型,满足:

38、

39、其中,为第根拖缆的水平张力,为权重矩阵,为拖缆力几何映射矩阵,为第根拖缆的预设最小水平张力,为第根拖缆能够提供的最大水平张力。

40、本发明所要解决的技术问题还可以通过以下的技术方案来进一步实现,对于以上所述的多无人拖船编队补偿拖曳控制方法,所述分配得到的拖缆水平张力用于形成各拖缆的期望水平张力指令,或者基于非线性悬链线模型确定与第根拖缆水平张力对应的拖缆两端水平距离,并结合第根拖缆在非驱动漂浮物上的拖点坐标和拖缆作用方向,确定第艘无人拖船的修正后期望位置;或者根据拖缆作用方向、分配得到的水平张力以及无人拖船推进器配置生成修正后的基准控制输入。

41、本发明所要解决的技术问题还可以通过以下的技术方案来进一步实现,对于以上所述的多无人拖船编队补偿拖曳控制方法,一种多无人拖船编队补偿拖曳控制系统,该系统包括:

42、状态采集模块,用于获取非驱动漂浮物、无人拖船和拖缆的状态信息;

43、几何时变编队生成模块,用于基于非驱动漂浮物参考轨迹以及非驱动漂浮物、拖缆和无人拖船之间的拖缆附着几何关系,生成各无人拖船的基准期望轨迹;

44、基础编队控制模块,用于控制各无人拖船跟踪所述基准期望轨迹,并通过拖缆形成几何时变编队基础拖曳;

45、拖曳系统反馈模块,用于基于拖缆非线性模型和拖曳系统动力学模型,获得所述非驱动漂浮物的位姿响应和残余跟踪误差;

46、补偿广义力生成模块,用于根据所述残余跟踪误差生成补偿广义力;

47、拖缆水平张力分配模块,用于将所述补偿广义力分配为各拖缆的水平张力;

48、修正控制模块,用于根据分配得到的拖缆水平张力形成拖缆期望水平张力指令,或修正各无人拖船的基准期望轨迹或基准控制输入。

49、与现有技术相比,本发明的有益效果:

50、第一,本发明以非驱动漂浮物参考轨迹、拖缆附着几何关系和无人拖船时变相对偏移量作为无人拖船基准期望轨迹生成依据,能够直接形成多无人拖船几何时变编队拖曳过程;

51、第二,本发明明确了无人拖船推进器、拖缆水平张力和拖缆力几何映射之间的作用关系,无人拖船推进器维持相对几何位置,拖缆被拉紧后产生水平张力,拖缆作用方向和拖点力臂将所述水平张力转化为作用于非驱动漂浮物的广义拖曳力;

52、第三,本发明基于几何时变编队基础拖曳后的残余跟踪误差构造鲁棒控制器,并通过拖缆水平张力分配实现残余跟踪误差补偿,使基础拖曳控制和误差补偿控制分层实现,有利于提高多无人拖船协同拖曳过程中的控制稳定性;

53、第四,本发明通过拖缆水平张力上下限约束,使分配得到的拖缆水平张力满足拖缆承载能力要求,有利于提高复杂海况下的轨迹跟踪精度和抗扰能力。