一种作业级ROV参考进度治理方法、系统、设备及介质

摘要: 本发明涉及水下机器人控制,具体而言,涉及一种作业级rov参考进度治理方法、系统、设备及介质。背景技术:1、随着海洋工程与水下作业技术的不断发展,作业级rov(r...
一种作业级ROV参考进度治理方法、系统、设备及介质

本发明涉及水下机器人控制,具体而言,涉及一种作业级rov参考进度治理方法、系统、设备及介质。

背景技术:

1、随着海洋工程与水下作业技术的不断发展,作业级rov(remotely operatedvehicle,无人遥控潜水器)被应用于海底管线巡检、水下结构物维护以及水下施工与海洋资源勘探等场景。作业级rov通常配置多台推进器,由控制器生成广义力需求后经推力分配模块分配至各推进器,实现路径跟踪与作业站位控制。

2、但是,相关技术中普遍采用后置限幅或饱和补偿的处理方式:控制器先基于原始任务参考生成控制指令,再由推力分配器对超出推进器执行能力的部分进行裁剪或饱和补偿。原始任务参考固定、裁剪动作后置的处理模式,使得控制器持续输出不可达控制需求,导致分配残差与推进器饱和不断累积,进而引发跟踪精度下降、姿态超调甚至推进器过热保护等问题,对推进器健康状态退化、海流扰动增强等工况变化的适应性较差,影响水下作业的安全性与执行效率。

技术实现思路

1、本发明解决的问题是如何提高作业级rov参考进度治理的效果。

2、为解决上述问题,本发明提供一种作业级rov参考进度治理方法、系统、设备及介质。

3、第一方面,本发明提供了一种作业级rov参考进度治理方法,包括:

4、建立作业级rov的六自由度运动模型、推进器布置模型与广义力分配模型;获取任务参考、实时状态、推进器健康度、上一周期推力、环境扰动估计与推进系统边界参数;获取认证阈值、安全阈值、进度速率限制与站位安全半径;

5、根据所述任务参考生成候选参考进度及候选参考;根据所述候选参考结合所述实时状态、所述环境扰动估计与所述六自由度运动模型,获取预控广义力需求;根据所述推进器健康度、所述上一周期推力与所述推进系统边界参数,构造安全推力区间;根据所述推进器布置模型构造所述广义力分配模型的分配矩阵;

6、基于所述分配矩阵与所述安全推力区间,根据所述候选参考进度对所述预控广义力需求执行广义力可达性认证,得到投影距离与预测饱和指标;将所述投影距离进行归一化,得到归一化残差,将所述归一化残差、所述预测饱和指标分别与所述认证阈值比较,得到可达性判定结果,根据所述可达性判定结果选取最大可达进度,并经所述进度速率限制得到治理参考进度;根据所述治理参考进度生成治理参考,当全部候选参考不可达或所述安全阈值触发时结合所述站位安全半径生成安全保持参考并进入安全保持模式;

7、将所述治理参考或所述安全保持参考输入控制器生成控制广义力需求,将所述控制广义力需求经所述广义力分配模型执行推力分配,驱动作业级rov,完成作业级rov参考进度治理。

8、可选地,所述根据所述推进器健康度、所述上一周期推力与所述推进系统边界参数构造安全推力区间,包括:

9、从所述推进器健康度中提取正向健康度与反向健康度;获取各推进器的正向名义边界与反向名义边界;

10、将所述推进器健康度的正向健康度与所述正向名义边界相乘,得到推进器的正向健康边界;将所述推进器健康度的反向健康度与所述反向名义边界相乘,得到推进器的反向健康边界;

11、根据所述上一周期推力与所述推进系统边界参数的推力变化率上限,以所述上一周期推力为基准按推力变化率上限向正向扩展得到推进器的正向速率边界,向反向扩展得到推进器的反向速率边界;对所述正向健康边界与所述正向速率边界取较小值,得到推进器的正向可用边界;对所述反向健康边界与所述反向速率边界取较小值,得到推进器的反向可用边界;

12、获取所述推进系统边界参数中的安全收紧比例,根据所述安全收紧比例对所述正向可用边界向内侧收缩得到安全推力区间的上界,对所述反向可用边界向内侧收缩得到安全推力区间的下界,形成推进器的安全推力区间。

13、可选地,所述基于所述分配矩阵与所述安全推力区间,根据所述候选参考进度对所述预控广义力需求执行广义力可达性认证,得到投影距离与预测饱和指标,包括:

14、在所述分配矩阵与所述安全推力区间的约束下,对各候选参考对应的预控广义力需求求解带边界加权最小二乘问题,得到最优投影推力;所述带边界加权最小二乘问题的目标函数为加权分配残差平方和,其中所采用的广义力加权矩阵根据安全自由度优先级预先设定;

15、根据所述最优投影推力经分配矩阵变换得到投影广义力,计算所述预控广义力需求与所述投影广义力的残差的加权二范数,得到投影距离;

16、计算各推进器的最优投影推力相对对应安全推力区间中点的相对偏离程度,取其中最大值得到预测饱和指标。

17、可选地,所述将所述投影距离进行归一化,得到归一化残差,包括:

18、将所述投影距离除以候选需求尺度得到归一化残差;所述候选需求尺度取经广义力加权矩阵加权的预控广义力需求的二范数,预设残差下限与小正数三者中的最大值。

19、可选地,所述将所述归一化残差、所述预测饱和指标分别与所述认证阈值比较,得到可达性判定结果,根据所述可达性判定结果选取最大可达进度,包括:

20、当所述归一化残差小于或等于所述认证阈值的残差阈值,且所述预测饱和指标小于或等于所述认证阈值的饱和阈值时,判定对应候选参考为可达,所有判定为可达的候选参考形成可达候选集合;

21、从所述可达候选集合中选取数值最大的候选参考进度作为最大可达进度。

22、可选地,所述结合所述站位安全半径生成安全保持参考并进入安全保持模式,包括:

23、按照优先级从高到低的顺序构造安全保持参考,深度或高度、横滚与纵倾、艏向、站位安全半径、路径进度、水平位置精度的所述优先级依次递减;

24、其中,所述深度或高度的安全保持参考取安全深度,所述横滚与纵倾的安全保持参考取零值,所述艏向的安全保持参考取当前艏向或迎流方向艏向;所述站位安全半径的安全保持参考取站位安全半径阈值,约束rov与周边水下设施、障碍物的最小距离不低于所述站位安全半径阈值;所述路径进度的安全保持参考取进入安全保持模式前的稳定参考进度节点,暂停进度增量调节,维持当前进度直至安全模式解除;水平位置精度的安全保持参考基于安全锚点构造,所述安全锚点为进入安全保持模式前根据作业级rov当前水平位置与所述站位安全半径确定的安全驻留点。

25、可选地,还包括:

26、采集各控制周期的分配残差,所述分配残差为控制广义力需求与实际推进器推力经分配矩阵变换得到的实际广义力之差;

27、将所述分配残差反馈至下一控制周期,当经所述广义力可达性认证判定为可达,但分配残差持续增大时,降低最大可达进度或增大安全收紧比例。

28、第二方面,本发明提供了一种作业级rov参考进度治理系统,包括:

29、模型参数获取模块,用于建立作业级rov的六自由度运动模型、推进器布置模型与广义力分配模型;获取任务参考、实时状态、推进器健康度、上一周期推力、环境扰动估计与推进系统边界参数;获取认证阈值、安全阈值、进度速率限制与站位安全半径;

30、认证输入准备模块,用于根据所述任务参考生成候选参考进度及候选参考;根据所述候选参考结合所述实时状态、所述环境扰动估计与所述六自由度运动模型,获取预控广义力需求;根据所述推进器健康度、所述上一周期推力与所述推进系统边界参数,构造安全推力区间;根据所述推进器布置模型构造所述广义力分配模型的分配矩阵;

31、参考进度治理模块,用于基于所述分配矩阵与所述安全推力区间,根据所述候选参考进度对所述预控广义力需求执行广义力可达性认证,得到投影距离与预测饱和指标;将所述投影距离进行归一化,得到归一化残差,将所述归一化残差、所述预测饱和指标分别与所述认证阈值比较,得到可达性判定结果,根据所述可达性判定结果选取最大可达进度,并经所述进度速率限制得到治理参考进度;根据所述治理参考进度生成治理参考,当全部候选参考不可达或所述安全阈值触发时结合所述站位安全半径生成安全保持参考并进入安全保持模式;

32、控制分配执行模块,用于将所述治理参考或所述安全保持参考输入控制器生成控制广义力需求,将所述控制广义力需求经所述广义力分配模型执行推力分配,驱动作业级rov,完成作业级rov参考进度治理。

33、第三方面,本发明提供了一种电子设备,包括存储器和处理器;

34、所述存储器,用于存储计算机程序;

35、所述处理器,用于当执行所述计算机程序时,实现如第一方面所述的作业级rov参考进度治理方法。

36、第四方面,本发明提供了一种计算机可读存储介质,所述存储介质上存储有计算机程序,当所述计算机程序被处理器执行时,实现如第一方面所述的作业级rov参考进度治理方法。

37、本发明的一种作业级rov参考进度治理方法、装置、设备及介质的有益效果是:在控制器之前前置广义力可达性认证环节,根据推进器健康度、上一周期推力与系统边界参数动态构造安全推力区间,使认证能够实时反映推进系统的真实执行能力。采用归一化残差与预测饱和指标双判据进行可达性判定:归一化残差衡量不可实现广义力占总需求的相对比例,预测饱和指标评估推进器接近边界的程度,两项指标共同约束使认证结果更为可靠。从可达候选中选取最大参考进度以保障作业效率,并通过快速降速、慢速恢复的非对称速率限制抑制扰动波动导致的控制抖振;全部候选不可达或安全阈值触发时,结合站位安全半径按优先级构造安全保持参考,极端工况下优先保障深度、姿态与艏向安全。控制器仅接收治理后的参考,避免了传统后置裁剪方式中控制器持续输出不可达指令的问题,有效减少分配残差累积与推进器饱和,提升跟踪精度。本发明通过前置认证驱动参考进度主动治理,使控制需求始终落在推进系统安全可达范围内,兼顾作业安全性与路径推进效率。