一种自主水下航行器四通道耦合控制方法技术

本发明专利技术提出一种自主水下航行器四通道耦合控制方法，首先分别获取姿态传感器和深度传感器数据，将各数据进行滤波处理；然后分别进行纵平面控制计算、水平面控制计算和横滚控制计算；之后进行舵角分配计算，将控制力矩分配到四个舵面上，得到操舵角度；然后获取速度传感器信息，进行滤波之后进行速度控制计算，得到控制转速指令；最后将舵角和转速指令发送到执行机构执行。本发明专利技术通过控制算法，使单桨加十字舵型AUV通过周期性控制舵角和转速，实现了AUV稳定航行，而且本发明专利技术中采用的舵角分配算法考虑到了AUV横滚带来的影响，对任意横滚角下的AUV都适用，特别是当AUV横滚角非零时，比传统的静态舵分配方法具有更好的控制效果。

A four channel coupling control method for autonomous underwater vehicle

The invention proposes a four-channel coupling control method for autonomous underwater vehicle. Firstly, the data of attitude sensor and depth sensor are acquired separately and filtered, then the longitudinal plane control calculation, horizontal plane control calculation and roll control calculation are carried out respectively, and then the rudder angle distribution calculation is carried out to calculate the control force. Moments are allocated to four rudder surfaces to get the steering angle; then speed sensor information is obtained, speed control calculation is carried out after filtering, and speed control instructions are obtained; finally, the steering angle and speed instructions are sent to the executing mechanism for execution. The present invention realizes stable navigation of AUV by periodically controlling the rudder angle and rotational speed of single propeller and cross rudder type AUV through control algorithm. The rudder angle allocation algorithm adopted in the present invention takes into account the influence of AUV roll and is applicable to AUV at any roll angle, especially when the roll angle of AUV is non-zero, it is more static than traditional AUV. The state rudder allocation method has better control effect.

【技术实现步骤摘要】
一种自主水下航行器四通道耦合控制方法
本专利技术涉及一种自主水下航行器控制方法，特别是对于螺旋桨推进加十字舵面布局的回转体自主水下航行器控制方法，属于水下航行器控制领域。
技术介绍
用于海洋探测与海底观测的无人潜水器(UnmannedUnderwaterVehicle，简称UUV)可分为遥控水下航行器(RemoteOperatedVehicle，简称ROV)和自主水下航行器(AutonomousUnderwaterVehicle，简称AUV)两种。与ROV相比，AUV作为一种水下自主运载工具，依靠自身所携带的能源航行，可完成水下测量、物品投送等任务，在军事海洋侦察、海洋环境监测、油田勘测等领域有着重要的作用。AUV具有活动范围与深度大、无脐带限制、可进入复杂结构体中、无需复杂水面支持系统、占用甲板小、运行维修费用低等优点。目前，回转体AUV舵面多采用十字形布局或者X型布局，与十字形布局不同的是X型布局需要把转矩分配到旋转了45°之后的四个舵面。但是无论是哪一种舵面布局，都存在AUV纵剖面与大地坐标系垂直面不总是重合的问题，因此固定的转矩和舵角分配方法会造成一定的误差和机动性损失，尤其带来转弯时的深度波动。
技术实现思路
为解决现有技术存在的问题，本专利技术提出一种采用十字舵面布局，同时对于任意横滚角下都适用的AUV四通道耦合控制方法。通过该控制方法计算相应执行机构指令，控制AUV稳定航行和有效作业。AUV控制方法主要包括：AUV纵平面运动控制算法、AUV水平面运动控制算法、AUV横滚控制算法、AUV舵角分配算法、AUV速度控制算法。本专利技术的技术方案为：所述一种自主水下航行器四通道耦合控制方法，其特征在于：包括以下步骤：步骤1：分别计算纵平面控制力矩、水平面控制力矩和横滚控制力矩：AUV纵平面运动控制采用AUV深度控制，根据AUV每个控制周期测量的深度、俯仰角和俯仰角速度，按照以下公式进行混合计算得到纵平面控制力矩：其中depth、depthref和deptherr分别为深度、参考深度和深度误差；θ和ωz分别为俯仰角和俯仰角速度；αf为AUV自由角；kpd、kid、kpθ和kdθ分别为深度比例系数、深度积分系数、俯仰角比例系数和俯仰角微分系数；Le为纵平面控制力矩；AUV水平面运动控制采用AUV航向角控制，根据AUV每个周期测量的航向角和航向角速度，按照以下公式经过混合计算得出水平面控制力矩：其中ψ、ψref和ψerr分别为航向角、参考航向角和航向角误差；ωy为航向角速度；kpψ和kdψ分别为航向角比例系数和航向角微分系数；Lr为水平面控制力矩；AUV横滚控制采用AUV横滚角控制，根据AUV每个周期测量的横滚角和横滚角速度，按照以下公式经过混合计算得出横滚角控制力矩：其中和ωx分别为横滚角和横滚角速度；和分别为横滚角比例系数和横滚角微分系数；Ld为横滚控制力矩；步骤2：根据步骤1计算得到的纵平面控制力矩、水平面控制力矩和横滚控制力矩，采用以下公式进行AUV舵角分配，将纵平面控制力矩、水平面控制力矩和横滚控制力矩分配到AUV的四个舵面上，通过舵面产生需要的控制力矩：其中，D＝[dudddldr]T为AUV上、下、左、右四个舵角值；kLD为力矩舵角转换系数；为加入横滚角修正的舵角分配矩阵；步骤3：AUV速度控制采用以下公式计算转速指令，调节AUV主推进电机的转速控制AUV的速度：其中F为速度与转速对应关系映射；vr为参考速度；为第k次速度误差；ke为误差积分系数；R为转速指令；步骤4：将步骤2和步骤3得到的舵角和转速指令发送到AUV执行机构执行。有益效果1、本专利技术通过控制算法，使单桨加十字舵型AUV通过周期性控制舵角和转速，实现了AUV稳定航行。2、本专利技术中采用的舵角分配算法考虑到了AUV横滚带来的影响，对任意横滚角下的AUV都适用，特别是当AUV横滚角非零时，比传统的静态舵分配方法具有更好的控制效果。3、本专利技术对于X型舵面AUV同样适用，只需对舵角分配矩阵稍作修改即可。4、本专利技术逻辑简单，计算量小，容易实现。本专利技术的附加方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本专利技术的实践了解到。附图说明本专利技术的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解，其中：图1AUV平台示意图图2本专利技术控制方法流程图图3AUV航行轨迹曲线图4AUV航行姿态角曲线图5AUV航行深度曲线图6AUV航行速度曲线具体实施方式本专利技术提出一种采用十字舵面布局，同时对于任意横滚角下都适用的AUV四通道耦合控制方法。通过该控制方法计算相应执行机构指令，控制AUV稳定航行和有效作业。具体包括以下步骤：步骤1：分别计算纵平面控制力矩、水平面控制力矩和横滚控制力矩：AUV纵平面运动控制采用AUV深度控制，根据AUV每个控制周期测量的深度、俯仰角和俯仰角速度，按照以下公式进行混合计算得到纵平面控制力矩：其中depth、depthref和deptherr分别为深度、参考深度和深度误差；θ和ωz分别为俯仰角和俯仰角速度；αf为AUV自由角；kpd、kid、kpθ和kdθ分别为深度比例系数、深度积分系数、俯仰角比例系数和俯仰角微分系数；Le为纵平面控制力矩；AUV水平面运动控制采用AUV航向角控制，根据AUV每个周期测量的航向角和航向角速度，按照以下公式经过混合计算得出水平面控制力矩：其中ψ、ψref和ψerr分别为航向角、参考航向角和航向角误差；ωy为航向角速度；kpψ和kdψ分别为航向角比例系数和航向角微分系数；Lr为水平面控制力矩；AUV横滚控制采用AUV横滚角控制，根据AUV每个周期测量的横滚角和横滚角速度，按照以下公式经过混合计算得出横滚角控制力矩：其中和ωx分别为横滚角和横滚角速度；和分别为横滚角比例系数和横滚角微分系数；Ld为横滚控制力矩；步骤2：根据步骤1计算得到的纵平面控制力矩、水平面控制力矩和横滚控制力矩，采用以下公式进行AUV舵角分配，将纵平面控制力矩、水平面控制力矩和横滚控制力矩分配到AUV的四个舵面上，通过舵面产生需要的控制力矩：其中，D＝[dudddldr]T为AUV上、下、左、右四个舵角值；kLD为力矩舵角转换系数；为加入横滚角修正的舵角分配矩阵；步骤3：AUV速度控制采用以下公式计算转速指令，调节AUV主推进电机的转速控制AUV的速度：其中F为速度与转速对应关系映射，可以通过试验获得；vr为参考速度；为第k次速度误差；ke为误差积分系数；R为转速指令；步骤4：将步骤2和步骤3得到的舵角和转速指令发送到AUV执行机构执行。下面详细描述本专利技术的实施例，所述实施例是示例性的，旨在用于解释本专利技术，而不能理解为对本专利技术的限制。便携式自主水下航行器如图1所示，AUV的艉部安装螺旋桨和四个舵面，采用十字形舵面布局。控制流程通过如下方案实现：如图2所示为AUV控制方法流程图，当新的控制周期开始时，首先分别获取姿态传感器和深度传感器数据，将各数据进行滤波处理；然后分别进行纵平面控制计算、水平面控制计算和横滚控制计算；之后进行舵角分配计算，将控制力矩分配到四个舵面上，得到操舵角度；然后获取速度传感器信息，进行滤波之后进行速度控制计算，得到控制转速指令；最后将舵角和转速指令发送到执行机构本文档来自技高网...

【技术保护点】
1.一种自主水下航行器四通道耦合控制方法，其特征在于：包括以下步骤：步骤1：分别计算纵平面控制力矩、水平面控制力矩和横滚控制力矩：AUV纵平面运动控制采用AUV深度控制，根据AUV每个控制周期测量的深度、俯仰角和俯仰角速度，按照以下公式进行混合计算得到纵平面控制力矩：

【技术特征摘要】
1.一种自主水下航行器四通道耦合控制方法，其特征在于：包括以下步骤：步骤1：分别计算纵平面控制力矩、水平面控制力矩和横滚控制力矩：AUV纵平面运动控制采用AUV深度控制，根据AUV每个控制周期测量的深度、俯仰角和俯仰角速度，按照以下公式进行混合计算得到纵平面控制力矩：其中depth、depthref和deptherr分别为深度、参考深度和深度误差；θ和ωz分别为俯仰角和俯仰角速度；αf为AUV自由角；kpd、kid、kpθ和kdθ分别为深度比例系数、深度积分系数、俯仰角比例系数和俯仰角微分系数；Le为纵平面控制力矩；AUV水平面运动控制采用AUV航向角控制，根据AUV每个周期测量的航向角和航向角速度，按照以下公式经过混合计算得出水平面控制力矩：其中ψ、ψref和ψerr分别为航向角、参考航向角和航向角误差；ωy为航向角速度；kpψ和kdψ分别为航向角比例系数和航向角微分系数；Lr为水平面控制力矩；A...

【专利技术属性】
技术研发人员：潘光，高剑，曹永辉，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西,61