一种“X”型尾翼拖曳体及其运动姿态控制方法技术

本发明专利技术提供了一种“X”型尾翼拖曳体及其运动姿态控制方法，它包括壳体，所述壳体的两侧壁上，并沿其长度方向依次布置有用于监测其加速度的加速度传感器和用于监测其压力的压力传感器；所述壳体顶部两侧的中间部位对称安装有水动力压板；所述壳体的底部中间部位安装有监测装置；所述壳体的尾部安装有X型尾翼；所述X型尾翼与尾翼驱动装置相连；所述壳体的内部还安装有用于驱动整个拖拽体的动力装置。其区别于垂直尾翼和水平尾翼，所提出的“X”型尾翼，能够兼顾水平尾翼和垂直尾翼的作用，保证水下拖曳体的航行姿态稳定性。

A \X\ Tail trailer and its attitude control method

The invention provides an \X\ tail-wing towing body and its motion attitude control method, which comprises a shell, an acceleration sensor for monitoring its acceleration and a pressure sensor for monitoring its pressure along its length direction on both sides of the shell, a hydrodynamic pressure plate symmetrically mounted on the middle part of both sides of the top of the shell, and a bottom part of the shell. A monitoring device is installed in the middle part; an X-tail is installed at the tail part of the shell; the X-tail is connected with the tail drive device; and a power device for driving the whole drag body is also installed in the inner part of the shell. It is different from the vertical tail and the horizontal tail. The proposed \X\ tail can take into account both the horizontal tail and the vertical tail to ensure the navigation attitude stability of the underwater towed body.

【技术实现步骤摘要】
一种“X”型尾翼拖曳体及其运动姿态控制方法
本专利技术属于海洋监测领域，特别涉及一种“X”型尾翼拖曳体及其运动姿态控制方法。
技术介绍
海洋拖曳系统作为一种高效的海洋探测平台，随着海洋开发的日益深入，已广泛地被应用于海洋研究、海洋监测、军事探测、水声对抗等诸多领域，并发挥着越来越重要的作用。随着世界各国对水下环境快速现场监测能力要求的提高，市场对该类装置的需求不断增加。拖曳体内所搭载的水下环境监测传感器的工作性质要求拖曳体工作时必须姿态稳定，并且具有灵活快速的深度和姿态的调节与控制能力。为此专家们一直都在为开发符合这种要求的水下拖曳体而做了大量的研究工作，提出了适应于不同用途的各种形式的水下拖曳体。如何在保证拖曳体姿态稳定的前提下使其能按照所要求的测量轨迹与姿态要求快速灵活地对其进行有效的操纵，是能否开发出一种经济实用、具有市场价值的水下拖曳体的关键。目前实现水下拖曳体控制的主要途径可分为两类:一是安装水平控制水翼，实现对拖体深度及其俯仰的控制；二是安装垂直控制水翼调节，实现对拖体偏航及其侧向位置的控制。现有拖曳体中深度控制装置和姿态控制装置分离，使得整体机构复杂，造价成本提高。在实际作业时海洋拖曳系统必然受到海浪和海流的影响作用，使得拖曳体的轨迹、姿态控制受到外界环境的强烈干扰，且变化不定，需基于上述的拖体主动控制，提出先进的控制理论，实现对系统的良好控制。
技术实现思路
基于此，本专利技术为了克服现有技术缺陷。提供了一种“X”型尾翼拖曳体及其运动姿态控制方法，其区别于垂直尾翼和水平尾翼，所提出的“X”型尾翼，能够兼顾水平尾翼和垂直尾翼的作用，保证水下拖曳体的航行姿态稳定性。为了实现上述的技术特征，本专利技术的目的是这样实现的：一种“X”型尾翼拖曳体，它包括壳体，所述壳体的两侧壁上，并沿其长度方向依次布置有用于监测其加速度的加速度传感器和用于监测其压力的压力传感器；所述壳体顶部两侧的中间部位对称安装有水动力压板；所述壳体的底部中间部位安装有监测装置；所述壳体的尾部安装有X型尾翼；所述X型尾翼与尾翼驱动装置相连；所述壳体的内部还安装有用于驱动整个拖拽体的动力装置。所述拖曳体还包括控制系统，所述控制系统包括拖曳体定深控制系统、拖曳体俯仰姿态控制系统和拖曳体横摇运动控制系统。所述壳体的顶部中心位置固定有拖缆连接座，所述拖缆连接座上连接有拖缆。所述水动力压板与用于驱动其动作的水动力压板驱动装置相连。所述X型尾翼包括下部的两对固定尾翼和上部的两对可调节攻角的尾翼组成。所述动力装置、尾翼驱动装置和用于驱动水动力压板的水动力压板驱动装置构成整个拖曳体的驱动装置，所述驱动装置包括伺服电机，所述伺服电机与减速器相连，所述减速器通过联轴器与锥齿轮传动机构相连；多个所述锥齿轮传动机构的输出端分别与动力装置、尾翼驱动装置和水动力压板驱动装置相连，并分别驱动X型尾翼进行拖曳体姿态调节以及水动力压板进行深度调节。所述监测装置根据不同的需要搭载温度、盐度、压力、海洋元素探测传感器或声、光物理探测传感器。所述定深控制系统包括定深PID控制器，所述定深PID控制器与水动力压板攻角控制系统相连，所述水动力压板攻角控制系统与水动力压板驱动装置相连，并控制其功角调节拖曳体的深度；压力传感器监测拖曳体的当前深度，并发送至定深PID控制器输入端。所述拖曳体俯仰姿态控制系统包括俯仰姿态PID控制器和拖缆张力控制系统，所述俯仰姿态PID控制器与水翼攻角控制系统相连，所述水翼攻角控制系统与水翼驱动装置相连，所述拖缆张力控制系统与母船液压绞车相连，所述母船液压绞车上连接有拖缆，所述水翼驱动装置和拖缆都与俯仰姿态耦合控制器相连，所述俯仰姿态耦合控制器与拖拽体相连，加速度传感器监测拖曳体的加速度信号，并发送至俯仰姿态PID控制器与水翼攻角控制系统；所述拖曳体横摇运动控制系统包括横摇运动PID控制器，所述横摇运动PID控制器与尾翼攻角控制系统相连，所述尾翼攻角控制系统与尾翼驱动装置相连，尾翼驱动装置与X型尾翼的两对可调节攻角的尾翼相连；加速度传感器监测拖曳体的加速度信号，并发送至横摇运动PID控制器。任意一项所述“X”型尾翼拖曳体的运动姿态控制方法，水下拖曳体通过拖缆连接座和拖缆进行连接，由拖曳体内部的加速度传感器和压力传感器分别实时监测拖曳体横摇运动、俯仰姿态和深度信息，经拖缆传输拖曳体深度、横摇运动、俯仰姿态信息和拖曳体底部监测装置捕获的监测信息；定深控制系统中定深PID控制器输入为上一时刻压力传感器监测的拖曳体深度与目标深度之差Zd，输出为应该给拖曳体垂向施加的外力Fz；水动力压板攻角控制系统输入为Fz，输出为水动力压板这一时刻的攻角θ；水动力压板驱动装置输入为这一时刻的攻角θ，结合该时刻拖曳系统的参数，求得下一时刻的深度z(k+1)，定深控制系统PID控制系统离散方程为：式中：T为采样周期；Ze(n-1)和Ze(n)为第n次和第n-1次采样所取得的深度差；Kp、Ki、Kd分别是比例系数、积分系数、微分系数；水动力压板驱动装置通过伺服电机接收偏转信号，经与伺服电机连接的减速器，与减速器连接的联轴器，通过弧齿锥齿轮传动控制水动力压板的攻角θ，来实现对拖曳体的深度控制；俯仰姿态控制系统中俯仰姿态PID控制器输入为上一个加速度传感器监测的拖曳体俯仰运动信息与目标信息之差Yd，输出为应该给拖曳体施加的外力FY；拖缆张力控制系统输入为FY，输出为这一时刻拖缆的张力FY′；母船液压绞车输入为FY′，输出为这一时刻拖缆的张力；水动力压板攻角控制系统输入为FY，输出为水动力压板这一时刻的攻角β；水动力压板驱动装置输入为这一时刻的攻角β，结合俯仰姿态耦合控制器计算该拖曳系统的参数，求得下一时刻的俯仰姿态信息y(k+1)；横摇运动控制系统中横摇运动PID控制器输入为上一时刻加速度传感器监测的拖曳体横摇运动信息与目标信息之差Xd，输出为应该给拖曳体施加的外力FZ′；X型尾翼的攻角控制系统输入为FZ′，输出为X型尾翼这一时刻的攻角γ；X型尾翼的尾翼驱动装置输入为这一时刻的攻角γ，结合该时刻拖曳系统的参数，求得下一时刻的横摇运动信息x(k+1)；所述尾翼驱动装置通过伺服电机接收偏转信号，经与伺服电机连接的减速器，与减速器连接的联轴器，通过弧齿锥齿轮传动控制X型尾翼的攻角β，来实现对拖曳体的横摇运动控制。本专利技术有如下有益效果：1、本专利技术利用水下扑翼俯仰运动产生升力的原理，通过控制水动力压板攻角改变水下拖曳体的升力，通过联合控制拖缆张力和水动力压板攻角改变水下拖曳体的俯仰姿态，通过控制X型尾翼攻角改变水下拖曳体的横摇运动。2、本专利技术将拖曳体的深度控制、俯仰姿态控制和横摇运动控制集成在一起，不仅能独立控制也能耦合控制，比较其他拖曳体中深度控制装置和姿态控制装置分离，使得整体机构简单，造价成本降低。3、本专利技术提出水动力压板和X型尾翼攻角控制方式是通过弧齿锥齿轮传动控制实现，具有传动效率高、传动比稳定、节省空间和寿命长等优点；4、本专利技术提出的X型尾翼，能够兼顾水平尾翼和垂直尾翼的作用，保证水下拖曳体的航行姿态稳定性；5、本专利技术提出了一种PID控制方法对拖曳体运动姿态控制，包括对拖曳体的定深控制、俯仰姿态控制和横摇运动控制。附图说明下面结合附图和实施例对本专利技术作进一步说明。图1为本专利技术的主本文档来自技高网...

【技术保护点】
1.一种“X”型尾翼拖曳体，其特征在于：它包括壳体(1)，所述壳体(1)的两侧壁上，并沿其长度方向依次布置有用于监测其加速度的加速度传感器(2)和用于监测其压力的压力传感器(3)；所述壳体(1)顶部两侧的中间部位对称安装有水动力压板(6)；所述壳体(1)的底部中间部位安装有监测装置(10)；所述壳体(1)的尾部安装有X型尾翼(8)；所述X型尾翼(8)与尾翼驱动装置(7)相连；所述壳体(1)的内部还安装有用于驱动整个拖拽体的动力装置(9)。

【技术特征摘要】
1.一种“X”型尾翼拖曳体，其特征在于：它包括壳体(1)，所述壳体(1)的两侧壁上，并沿其长度方向依次布置有用于监测其加速度的加速度传感器(2)和用于监测其压力的压力传感器(3)；所述壳体(1)顶部两侧的中间部位对称安装有水动力压板(6)；所述壳体(1)的底部中间部位安装有监测装置(10)；所述壳体(1)的尾部安装有X型尾翼(8)；所述X型尾翼(8)与尾翼驱动装置(7)相连；所述壳体(1)的内部还安装有用于驱动整个拖拽体的动力装置(9)。2.根据权利要求1所述一种“X”型尾翼拖曳体，其特征在于：所述拖曳体还包括控制系统，所述控制系统包括拖曳体定深控制系统、拖曳体俯仰姿态控制系统和拖曳体横摇运动控制系统。3.根据权利要求1所述一种“X”型尾翼拖曳体，其特征在于：所述壳体(1)的顶部中心位置固定有拖缆连接座(5)，所述拖缆连接座(5)上连接有拖缆。4.根据权利要求1所述一种“X”型尾翼拖曳体，其特征在于：所述水动力压板(6)与用于驱动其动作的水动力压板驱动装置(4)相连。5.根据权利要求1所述一种“X”型尾翼拖曳体，其特征在于：所述X型尾翼(8)包括下部的两对固定尾翼和上部的两对可调节攻角的尾翼组成。6.根据权利要求1所述一种“X”型尾翼拖曳体，其特征在于：所述动力装置(9)、尾翼驱动装置(7)和用于驱动水动力压板(6)的水动力压板驱动装置(4)构成整个拖曳体的驱动装置，所述驱动装置包括伺服电机，所述伺服电机与减速器相连，所述减速器通过联轴器与锥齿轮传动机构相连；多个所述锥齿轮传动机构的输出端分别与动力装置(9)、尾翼驱动装置(7)和水动力压板驱动装置(4)相连，并分别驱动X型尾翼(8)进行拖曳体姿态调节以及水动力压板(6)进行深度调节。7.根据权利要求1所述一种“X”型尾翼拖曳体，其特征在于：所述监测装置(10)根据不同的需要搭载温度、盐度、压力、海洋元素探测传感器或声、光物理探测传感器。8.根据权利要求2所述一种“X”型尾翼拖曳体，其特征在于：所述定深控制系统包括定深PID控制器，所述定深PID控制器与水动力压板攻角控制系统相连，所述水动力压板攻角控制系统与水动力压板驱动装置(4)相连，并控制其功角调节拖曳体的深度；压力传感器(3)监测拖曳体的当前深度，并发送至定深PID控制器输入端。9.根据权利要求2所述一种“X”型尾翼拖曳体，其特征在于：所述拖曳体俯仰姿态控制系统包括俯仰姿态PID控制器和拖缆张力控制系统，所述俯仰姿态PID控制器与水翼攻角控制系统相连，所述水翼攻角控制系统与水翼驱动装置相连，所述拖缆张力控制系统与母船液压绞车相连，所述母船液压绞车上连接有拖缆，所述水翼驱动装置和拖缆都与俯仰姿态耦合控制器相连，所述俯仰姿态耦合控制器与...

【专利技术属性】
技术研发人员：方子帆，郑小伟，余红昌，何雪辉，谢哲雨，覃琳，
申请(专利权)人：三峡大学，
类型：发明
国别省市：湖北,42