一种面向欠驱动AUV的航行控制方法技术

本发明专利技术涉及一种基于智能积分的分段PID控制与模糊控制方法融合的欠驱动AUV航行控制方法，该方法将欠驱动AUV航行控制分为采用带有仿人智能积分的PID控制方法进行水平面航行控制和采用带有智能积分的分段PID控制与模糊控制结合的垂直面航行控制两部分，控制过程中两部分根据各自的控制方法单独运行，控制参数互不耦合，能够分别输出航行器的目标垂直舵角及目标水平舵角从而实现对欠驱动AUV的航行控制功能。该控制方法消除了垂直面控制对稳态攻角的依赖并减小了欠驱动AUV航速变化对航行控制参数的影响，因而减少了控制方法中需要整定的参数及参数整定的难度。参数及参数整定的难度。参数及参数整定的难度。

【技术实现步骤摘要】
一种面向欠驱动AUV的航行控制方法


[0001]本专利技术涉及一种欠驱动AUV航行控制方法，具体说是一种基于智能积分PID控制与模糊控制方法融合的欠驱动AUV航行控制方法。

技术介绍

[0002]欠驱动AUV是指独立控制输入维数少于系统自由度的海洋机器人，其代表是采用主推进器+鳍舵(或一组锥形分布的矢量推进器，一般为4个)作为航行控制执行机构的AUV。国内在该类型AUV航行控制方面多采用单独的PID控制、滑膜控制及模糊控制的控制方法。这些方法的PID过程中的积分环节是普通的不具有智能判断的积分方法。这种积分方法在欠驱动AUV控制过程中具有以下几点不足：
[0003](1)当被控量发生阶跃时在被控量向新目标值趋近过程中且尚未达到目标值前，会对误差信息进行过多累加，该过程容易产生较大的超调量，进而加长调节时间；
[0004](2)当被控量发生超调并且比例和积分环节已产生控制作用导致超调量正在减少时，对误差信息仍在累加，这会照成反向超调，进而加长调节时间。
[0005](3)当由于稳态误差存在进而积分项产生控制作用后，在被控量本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种面向欠驱动AUV的航行控制方法，其特征在于，包括：水平面航行控制方法，通过AUV上的惯性测量单元分别获取AUV的航向角及航向角速度，用以控制AUV在水平面航行；垂直面航行控制方法，通过AUV上深度计获取AUV的当前深度，通过AUV上的惯组单元获取AUV的当前纵顷角及纵顷角速度，用以控制AUV在垂直面航行。2.根据权利要求1所述的一种面向欠驱动AUV的航行控制方法，其特征在于，所述水平面航行控制方法为：rud
ver
＝P_h
i
*d_heading+D_h
i
*heading_rate+I_h
i
*i_heading
i
其中，rud
ver
表示垂直舵角控制值，d_heading表示航向角偏差，heading_rate表示航向角速度，i_heading
i
表示航向角偏差积分，P_h
i
、D_h
i
和I_h
i
分别表示比例系数、微分系数和积分系数，各参数中的下标i表示不同航速下的对应量如2节、3节、4节航速。3.根据权利要求2所述的一种面向欠驱动AUV的航行控制方法，其特征在于，在航向角偏差积分计算时，存在以下情况：(1)当目标航向与当前航向的差值增大时，则进行积分；(2)当航向角当前值与目标值间存在偏差且航向角当前值与目标值间的偏差变化率小于门限值时，则进行积分；(3)当航向角当前值与目标值间的偏差处于除上述情况之外的状态，均不进行积分计算。4.根据权利要求1所述的一种面向欠驱动AUV的航行控制方法，其特征在于，所述垂直面航行控制方法为：1)根据当前深度误差及深度变化率求出目标纵倾角：2)根据当前纵倾角偏差和纵倾角速度求出目标水平舵角输出量：rud
hor
＝P_vp
i
*d_pitch+D_vp
i
*pitch_rate其中，rud
hor
表示水平舵角控制值，pitch_t表示目标纵倾角，pitch_thres表示当前深度与目标深度的偏差大于阈值时...

【专利技术属性】
技术研发人员：贾松力，林扬，朱兴华，孙晓宇，孙铁，
申请(专利权)人：中国科学院沈阳自动化研究所，
类型：发明
国别省市：