一种水下机器人大潜深下潜中推进器及主动故障诊断方法

摘要

本发明属于水下机器人领域，具体涉及一种水下机器人大潜深下潜中推进器及主动故障诊断方法。该推进器由主体部分，下潜压载，上浮压载，控制计算机，惯导系统，深度计，水平方向上的左推进器，右推进器，提供垂直方向推力的前推进器和后推进器构成，本发明所述的主动故障诊断方法，可在水下机器人大潜深下潜过程中，尽早发现推进器存在的故障，及时回收维修，减少已经下潜至深海，而在执行作业任务过程中再发现故障，所造成的人力、物力损失；该方法，在下潜过程中，可及时发现垂向推进器存在的故障，减小水下机器人因推进器故障坐落海底的风险。

说明书

技术领域

本发明属于水下机器人领域，具体涉及一种水下机器人大潜深下潜中推进器及主动故障诊断方法。

背景技术

大潜深水下机器人，例如全海深AUV、ARV和HOV组成的深渊科考装备体系是当今海洋科技发展最高水平的标志，该体系将带动我国深海装备相关技术与深渊科学研究达到世界先进水平。

但由于大潜深水下机器人常常在未知的水域活动，周围的环境复杂多变，推进器很有可能受到损伤，出现故障。若故障未被及时检测，会影响水下作业任务的完成，而在垂向推进器出现故障的时候，存在水下机器人坐落海底的风险，甚至该风险将导致水下机器人无法回收，为研究带来巨大损失。

现有的故障诊断技术多为在任务作业过程中进行诊断，例如专利号CN201610169230.X，名称为基于改进灰色预测GM(1,1)模型自主水下航行器传感器故障诊断方法，便是在作业任务中通过收集传感器信息，利用灰色预测模型诊断传感器故障。但该方法的诊断依赖于作业任务中的传感器信息，若推进器在大潜深作业之前已经存在故障，在任务中才被发现，将导致任务的中断，回收水下机器人进行故障修复后才可以再次投入使用，这其中会造成人力、物力的损失。

专利号CN201510766653.5，名称为一种基于改进神经网络的智能水下机器人推进器故障诊断方法，在发现横向速度和艏向角的残差超过阈值的时候，执行主动故障诊断，在首尾垂推施加同样大小的正向推力，通过艏向角残差判断故障。但这种方法仅依靠艏向角残差判断是否故障，很难直观看出推进器的受损情况。

因此，研究水下机器人的主动故障诊断能力，对于提高航行器本身的智能性，减小作业任务中的损失不可或缺。然而，前文所述的主动故障诊断方法都是在水下机器人在执行任务过程中，通过艏向角等状态的反馈检测故障。若已经下潜至海底，在作业任务中才发现推进器的故障，无法完成作业任务，需要将水下机器人进行回收维护，再重新布放，而由于大潜深水下机器人的下潜上浮过程时间漫长，这个过程耗费大量的人力、物力，甚至水下机器人存在丢失的风险。

发明内容

本发明目的在于提供一种水下机器人大潜深下潜中推进器。

一种水下机器人大潜深下潜中推进器，该推进器由主体部分1，下潜压载2，上浮压载3，控制计算机4，惯导系统5，深度计6，水平方向上的左推进器7，右推进器8，提供垂直方向推力的前推进器9和后推进器10构成，主体部分1是一个圆边的类长方体，前推进器9安装于主体部分1其中一面的中部，后推进器10安装于主体部分1与前推进器9相对一面的外侧中部，左推进器7安装于主体部分1的中部，控制计算机4安装在主体部分1的非前推进器9与后推进器10所在面的其中一面的内侧中部，下潜压载2与上浮压载3合并安装于主体部分1与控制计算机4相对一面的外侧中部，惯导系统5安装在下潜压载2与上浮压载3所在面的内侧中点位置，深度计6安装于惯导系统5旁边靠近后推进器10的一侧。

本发明目的还在于提供一种针对水下机器人在大潜深下潜过程中由于推进器故障所带来的风险，减少由于潜在推进器故障带来的损失的水下机器人大潜深下潜中推进器主动故障诊断方法。

一种水下机器人大潜深下潜中推进器主动故障诊断方法，包括以下步骤：

步骤1，水下机器人1由吊车从挂载，布放到水中，进行浮态调整；

步骤2，对水平面左推进器7和右推进器8进行主动诊断：

步骤2.1，控制计算机4向左推进器7下达预定推力预定节拍控制指令；

步骤2.2，惯导系统5测量解算艏向角及艏向角变化率，发送给控制计算机4；

步骤2.3，控制计算机4中的滤波器估计转艏力矩推力损失，若大于阈值，则发送左推进器7故障标识到母船，转到步骤2.7，否则转到步骤2.4；

步骤2.4，控制计算机4向右推进器8下达预定推力预定节拍控制指令；

步骤2.5，惯导系统5测量解算艏向角及艏向角变化率，发送给控制计算机4；

步骤2.6，控制计算机4中的滤波器估计转艏力矩推力损失，若大于阈值，则发送右推进器8故障标识到母船，转到步骤2.7，否则转到步骤3；

步骤2.7，试验人员回收水下机器人1并维护；

步骤3，对垂直面内的前推进器9和后推进器10进行主动故障诊断：

步骤3.1，控制计算机4同时向前推进器9和后推进器10下达预定推力预定节拍控制指令；

步骤3.2，惯导系统5测量解算垂向速度，纵倾角和纵倾角变化率，发送给控制计算机4；

步骤3.3，控制计算机4中的滤波器估计纵倾力矩推力损失，若大于阈值，则转到步骤3.4，否则转到步骤4；

步骤3.4，试验人员回收水下机器人1并维护。

步骤4，控制计算机4设定垂向推进器无故障情况下，下潜压载2的抛离深度；

步骤5，水下机器人1在下潜压载2的作用下，无动力下潜；

步骤6，控制计算机4根据所述步骤5中深度计的6信息判断是否到达下潜压载2的抛离高度，若到达抛离高度，转到步骤9，否则转到步骤7；

步骤7，控制计算机4记录深度计6信息，每下潜500m，重复步骤2，进行水平面推进器主动诊断，若未发现故障，转到步骤8，否则认为在水平推进器存在较大故障的情况下，很难完成预定探索任务，同时抛离下潜压载2以及上浮压载3，上浮到水面进行维护；

步骤8，重复步骤3进行垂直面推进器主动诊断，若未发现故障，转到步骤5，否则，继续判断是否是单个垂向推进器发生故障：

步骤8.1，控制计算机4向前推进器8下达预定推力预定节拍控制指令；

步骤8.2，惯导系统5测量纵倾角和纵倾角变化率，发送给控制计算机4；

步骤8.3，控制计算机4中的滤波器估计纵倾力矩推力损失，若与步骤2.6中所估计的纵倾力矩推力损失之间偏差小于阈值，则发送前推进器8故障标识到母船，转到步骤8.4，否则转到步骤8.5；

步骤8.4，控制计算机4修改增加下潜压载2的抛离深度；

步骤8.5，在前后垂向推进器9和10均存在故障情况下，认为抛离压载的减速过程存在较大风险，容易发生坐落海底危险，控制计算机4发出指令，水下机器人1抛离上浮压载1和下潜压载2，试验人员回收水下机器人1并维护。

步骤9，水下机器人1到达预定下潜压载2抛离深度，水下机器人1抛掉下潜抛载2，进入作业面，开始作业任务。

本发明的和现有技术相比，有益效果在于：

1.本发明所述的主动故障诊断方法，可在水下机器人大潜深下潜过程中，尽早发现推进器存在的故障，及时回收维修，减少已经下潜至深海，而在执行作业任务过程中再发现故障，所造成的人力、物力损失；

2.本发明所述的主动故障诊断方法，在下潜过程中，可及时发现垂向推进器存在的故障，减小水下机器人因推进器故障坐落海底的风险。

附图说明

图1为本发明示例水下机器人的基本结构图；

图2为本发明水下机器人大潜深下潜过程主动诊断流程图；

图3为本发明主动诊断水平面推进器故障详细流程图；

图4为本发明主动诊断垂直面推进器故障详细流程图。

具体实施方式

下面结合附图对本发明进行更详细的描述：

一种水下机器人在大潜深下潜过程中，每下潜一定深度，便通过预定控制指令，通过状态反馈，主动检测推进器故障的方法。该方法可尽可能减小因故障而重复投放水下机器人所带来的人力、物力损失，同时降低水下机器人坐落海底的风险。本发明所述的对推力损失信息进行估计的滤波器，利用了水下机器人的运动模型建立。

本发明提供了一种水下机器人在大潜深下潜中主动诊断推进器故障的方法，所述的主动诊断方法,即在水下机器人大潜深下潜过程中，每间隔一定下潜深度，由控制计算机分别向水平面与垂直面推进器下达预定控制指令。所述的控制计算机中的滤波器依据水下机器人的状态反馈信息，估计相应自由度存在的推力损失。所估计的推力损失超过设定阈值时，判断推进器存在故障，再根据能否完成任务要求判断是否需要回收维护。所述的下潜深度信息由水下机器人搭载的深度计提供，所述的状态反馈信息由惯导系统提供。本发明提供的主动故障诊断方法，可在水下机器人大潜深下潜过程中，尽早发现推进器存在的故障，及时回收维修，减少已经下潜至深海，在执行作业任务过程中才发现故障所造成的人力、物力损失；同时，在下潜过程中，及时发现垂向推进器存在的故障，可减小水下机器人因为垂向推进器故障发生的坐落海底风险。

本发明提供一种水下机器人大潜深下潜中推进器主动诊断方法，包括以下步骤：

步骤1，水下机器人由吊车从母船挂载，被吊放到水中，并进行浮态调整；

步骤2，主动诊断水平面推进器故障：控制计算机分别对水平方向上左右推进器下达预定推力预定节拍的控制指令，惯导系统获取艏向角以及艏向角变化率，并通过滤波器对水平自由度存在的推力损失进行估计，若所述的推力损失超过阈值，则认为推进器存在故障，由控制计算机向母船发送故障标识，试验人员对水下机器人进行回收；

步骤3，主动诊断垂直面推进器故障：控制计算机对垂直方向上的前后推进器下达控制指令，惯导系统获取垂向速度以及纵倾角变化信息，并通过滤波器对推力损失进行估计，若所述的推力损失超过阈值，认为推进器存在故障，回收水下机器人并维护；

步骤4，初始化设定下潜压载的抛离深度，该数值将根据垂直面推进器的故障情况进行后续修正；

步骤5，水下机器人无动力下潜；

步骤6，根据深度计的信息判断是否到达抛离压载的深度，若到达抛离深度，转到步骤9，否则转到步骤7；

步骤7，水下机器人记录深度计信息，每下潜500m深，重复步骤2主动诊断水平面推进器故障，若未发现故障，转到步骤8，否则回收水下机器人并对推进器进行维护；

步骤8，重复步骤3主动诊断垂直面推进器故障，若未发现故障，转到步骤5，否则分别对垂直面前后推进器下达控制指令，判断是否是单个垂向推进器发生故障。若只有单个垂向推进器故障，则修正步骤4中的下潜压载抛离深度，否则回收水下机器人并对推进器进行维护；

步骤9，水下机器人到达抛离下潜压载的深度，抛离下潜压载，进入作业面，开始作业任务；

图1为本发明示例所采用的大潜深水下机器人的基本结构示意图，由于该水下机器人推进器布置形式已经属于简单模式，所述的主动故障诊断方法，若应用在其他不同数量推进器的大潜深水下机器人上，仅需要针对特定水下机器人，对需要主动诊断的推进器数目进行调整，而整个主动故障诊断的思想是一致的。由图1可知，所述的大潜深水下机器人由主体部分1，下潜压载2，上浮压载3，控制计算机4，惯导系统5，深度计6，水平方向上的左推进器7，右推进器8，提供垂直方向推力的前推进器9和后推进器10构成。

下面结合图2到图4，对水下机器人推进器主动故障诊断的流程进行进一步阐述：

步骤1，水下机器人1由吊车从挂载，布放到水中，进行浮态调整；

步骤2，对水平面左推进器7和右推进器8进行主动诊断：

步骤2.1，控制计算机4向左推进器7下达预定推力预定节拍控制指令；

步骤2.2，惯导系统5测量解算艏向角及艏向角变化率，发送给控制计算机4；

步骤2.3，控制计算机4中的滤波器估计转艏力矩推力损失，若大于阈值，则发送左推进器7故障标识到母船，转到步骤2.7，否则转到步骤2.4；

步骤2.4，控制计算机4向右推进器8下达预定推力预定节拍控制指令；

步骤2.5，惯导系统5测量解算艏向角及艏向角变化率，发送给控制计算机4；

步骤2.6，控制计算机4中的滤波器估计转艏力矩推力损失，若大于阈值，则发送右推进器8故障标识到母船，转到步骤2.7，否则转到步骤3；

步骤2.7，试验人员回收水下机器人1并维护；

步骤3，对垂直面内的前推进器9和后推进器10进行主动故障诊断：

步骤3.1，控制计算机4同时向前推进器9和后推进器10下达预定推力预定节拍控制指令；

步骤3.2，惯导系统5测量解算垂向速度，纵倾角和纵倾角变化率，发送给控制计算机4；

步骤3.3，控制计算机4中的滤波器估计纵倾力矩推力损失，若大于阈值，则转到步骤3.4，否则转到步骤4；

步骤3.4，试验人员回收水下机器人1并维护。

步骤4，控制计算机4设定垂向推进器无故障情况下，下潜压载2的抛离深度；

步骤5，水下机器人1在下潜压载2的作用下，无动力下潜；

步骤6，控制计算机4根据深度计6信息判断是否到达下潜压载2的抛离高度，若到达抛离高度，转到步骤9，否则转到步骤7；

步骤7，控制计算机4记录深度计6信息，每下潜500m，重复步骤2，进行水平面推进器主动诊断，若未发现故障，转到步骤8，否则认为在水平推进器存在较大故障的情况下，很难完成预定探索任务，同时抛离下潜压载2以及上浮压载3，上浮到水面进行维护；

步骤8，重复步骤3进行垂直面推进器主动诊断，若未发现故障，转到步骤5，否则，继续判断是否是单个垂向推进器发生故障：

步骤8.1，控制计算机4向前推进器8下达预定推力预定节拍控制指令；

步骤8.2，惯导系统5测量纵倾角和纵倾角变化率，发送给控制计算机4；

步骤8.3，控制计算机4中的滤波器估计纵倾力矩推力损失，若与步骤2.6中所估计的纵倾力矩推力损失之间偏差小于阈值，则发送前推进器8故障标识到母船，转到步骤8.4，否则转到步骤8.5；

步骤8.4，控制计算机4修改增加下潜压载2的抛离深度；

步骤8.5，在前后垂向推进器9和10均存在故障情况下，认为抛离压载的减速过程存在较大风险，容易发生坐落海底危险，控制计算机4发出指令，水下机器人1抛离上浮压载1和下潜压载2，试验人员回收水下机器人1并维护。

步骤9，水下机器人1到达预定下潜压载2抛离深度，水下机器人1抛掉下潜抛载2，进入作业面，开始作业任务。

本发明所述的对推力损失信息进行估计的滤波器，根据水下机器人的运动模型建立，利用水下机器人的状态信息，估计在不同自由度上的推力损失。利用所述的滤波器，可判断推进器的故障情况，辅助决策能否继续执行试验任务。

步骤1，水下机器人由吊车从母船挂载，被吊放到水中，并进行浮态调整；

步骤2，主动诊断水平面推进器故障：控制计算机分别对水平方向上左右推进器下达预定推力预定节拍的控制指令，惯导系统获取艏向角以及艏向角变化率，并通过滤波器对水平自由度存在的推力损失进行估计，若所述的推力损失超过阈值，则认为推进器存在故障，由控制计算机向母船发送故障标识，试验人员对水下机器人进行回收；

步骤3，主动诊断垂直面推进器故障：控制计算机对垂直方向上的前后推进器下达控制指令，惯导系统获取垂向速度以及纵倾角变化信息，并通过滤波器对推力损失进行估计，若所述的推力损失超过阈值，认为推进器存在故障，回收水下机器人并维护；

步骤4，初始化设定下潜压载的抛离深度，该数值将根据垂直面推进器的故障情况进行后续修正；

步骤5，水下机器人无动力下潜；

步骤6，根据深度计的信息判断是否到达抛离压载的深度，若到达抛离深度，转到步骤9，否则转到步骤7；

步骤7，水下机器人记录深度计信息，每下潜500m深，重复步骤2主动诊断水平面推进器故障，若未发现故障，转到步骤8，否则回收水下机器人并对推进器进行维护；

步骤8，重复步骤3主动诊断垂直面推进器故障，若未发现故障，转到步骤5，否则分别对垂直面前后推进器下达控制指令，判断是否是单个垂向推进器发生故障。若只有单个垂向推进器故障，则修正步骤4中的下潜压载抛离深度，否则回收水下机器人并对推进器进行维护；

步骤9，水下机器人到达抛离下潜压载的深度，抛离下潜压载，进入作业面，开始作业任务。