[发明专利]一种UUV往返式对接航路控制方法

说明书

本发明提供一种UUV往返式对接航路控制方法，解决传统对接方法依赖UUV自身定位信息和目标位置信息，对硬件成本要求高，目标口朝向发生变化，需重新计算就位点的问题。UUV在远程导引期间，根据导引指令接近对接装置，持续航行至目标附近时，按照对接口朝向远离目标，远离一定距离后掉头，此时UUV的主航向已平行于对接中轴线，之后UUV依据导引信息、航向信息判断UUV航路与对接中轴线的夹角，以此为依据向对接中轴线横移，通过1～2次横移即可航行在对接中轴线上或对接中轴线附近，为末程精确对接提供良好的态势。该方案不需依赖定位信息，仅靠导引信息、目标口朝向信息，即可完成对接航路控制，并利用对接口朝向的顺流特性，解决了洋流对航向的影响。

技术领域

本发明属于水下航行器航行控制技术领域，具体涉及一种UUV往返式对接航路控制方法。

背景技术

随着信息技术的不断发展，无人低速水下航行器(UUV)作为探索海洋空间的有力工具之一，在军事和科学研究方面起着越来越重要的作用。未来的UUV需要更长的水下工作时间、更隐蔽的信息收集能力以及更强大的通信能力，而这些目标的实现主要受到自身携带的能源和水下通信能力的限制，因此，水下对接装置作为补给支持及信息交换系统就显得十分重要。

目前，国内外涌现了多种对接(接驳)系统，根据对接协作目标的结构要求可以分为全方位对接装置和单一方向对接装置。全方位对接装置结构复杂，而单一方向对接装置设计简单，易于实现。

单一方向对接装置常采用圆锥形结构或喇叭口形结构，通过缆绳锚系于海底或直接坐底，此类装置对接口设计简单，但对接口一般尺寸较小，也没有相应的机械手等辅助机构，对接难度较高。对接用UUV一般采用单一尾部推进，以减小UUV直径，这对UUV控制提出了较高的要求，UUV的稳定控制、对接航路控制均需要良好的控制算法。

对接航路设计时，需同时兼顾目标点、目标朝向的需求。一般的思路是从远处向水下对接装置(对接目标)机动时，将目标视为单点，此时航路控制较简单，只需按照导引指令进行相应机动；当UUV机动至对接目标一定距离时，航路控制不仅要按照导引指令接近目标，还必须兼顾对接口朝向和对接“面”(将对接口朝向的中轴线视为对接控制面)的需求，两者统筹兼顾才能实现对接；同时，对接用UUV速度低，易被洋流影响，对接航路还需考虑洋流作用，尽量降低洋流带来的误差。

从目前公开资料看，对接航路控制一般采取先航行至中途就位点，再从就位点进行精确接驳的方式，如附图1所示。这种方法下，远程需利用UUV自身信息(主要为定位信息)计算就位点，到达就位点后，再沿中轴线向对接口进行精确接驳。这种方法虽然算法易实现，但依赖UUV自身的定位信息和目标位置信息，对硬件成本要求较高，同时对接期间目标口朝向发生变化时，需重新计算就位点。

发明内容

本发明的目的在于解决传统对接方法依赖UUV自身的定位信息和目标位置信息，对硬件成本要求较高，同时对接期间目标口朝向发生变化时，需重新计算就位点的问题，而提供一种UUV往返式对接航路控制方法。

为实现上述目的，本发明所提供的技术解决方案是：

一种UUV往返式对接航路控制方法，其特殊之处在于，包括以下步骤：

1)水下航行器导引系统搜寻目标水下对接装置，并将导引信息反馈给水下航行器控制系统；

2)水下航行器控制系统按照步骤1)反馈的导引信息生成导引指令控制UUV执行远程接近；

3)直至UUV与目标水下对接装置距离小于30米时，水下航行器控制系统控制UUV远离目标水下对接装置进行航行，主航向与目标水下对接装置的对接口朝向相同；

4)UUV航行至与目标水下对接装置距离大于160米时，水下航行器控制系统控制UUV掉头(原航向角+180°)正对目标水下对接装置继续航行，同时，导引系统再次搜寻目标水下对接装置，并将导引信息反馈给水下航行器控制系统；