CN115357036A - 欠驱动水下航行器的双层抗扰深度跟踪控制方法及*** - Google Patents
欠驱动水下航行器的双层抗扰深度跟踪控制方法及*** Download PDFInfo
- Publication number
- CN115357036A CN115357036A CN202211102526.1A CN202211102526A CN115357036A CN 115357036 A CN115357036 A CN 115357036A CN 202211102526 A CN202211102526 A CN 202211102526A CN 115357036 A CN115357036 A CN 115357036A
- Authority
- CN
- China
- Prior art keywords
- angle
- depth
- underwater vehicle
- sliding mode
- tracking
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 239000002131 composite material Substances 0.000 claims abstract description 37
- 230000007613 environmental effect Effects 0.000 claims abstract description 8
- 230000003044 adaptive effect Effects 0.000 claims description 28
- 238000012938 design process Methods 0.000 claims description 15
- 230000001133 acceleration Effects 0.000 claims description 14
- 238000004364 calculation method Methods 0.000 claims description 10
- 238000013461 design Methods 0.000 claims description 8
- 150000001875 compounds Chemical class 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 6
- 230000036039 immunity Effects 0.000 claims description 6
- 230000015572 biosynthetic process Effects 0.000 claims description 5
- 230000010354 integration Effects 0.000 claims description 5
- 238000003786 synthesis reaction Methods 0.000 claims description 5
- 230000000694 effects Effects 0.000 claims description 4
- 239000000203 mixture Substances 0.000 claims description 2
- 230000007246 mechanism Effects 0.000 abstract description 3
- 230000000007 visual effect Effects 0.000 abstract description 2
- 238000012360 testing method Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000009189 diving Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000005303 weighing Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/048—Control of altitude or depth specially adapted for water vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-water vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/24—Automatic depth adjustment; Safety equipment for increasing buoyancy, e.g. detachable ballast, floating bodies
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/001—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations
- B63G2008/002—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations unmanned
- B63G2008/004—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations unmanned autonomously operating
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/18—Control of attitude or depth by hydrofoils
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种欠驱动水下航行器的双层抗扰深度跟踪控制方法及***,将欠驱动水下航行器的深度跟踪分为运动学层制导和动力学层纵倾跟踪。在运动学层使用自适应视线角制导将深度误差转化为期望纵倾角,并估计和补偿攻角以抵抗真实攻角不可测引入的干扰。在此基础上,在动力学层使用自抗扰‑滑模纵倾跟踪方法,使用自抗扰框架观测包括未知动力学模型和环境干扰的复合干扰,将模型补偿为统一的积分串联型,最后设计滑模控制律抵抗观测误差,计算升降舵控制舵角。上述控制方法部署于航行器艇载计算机上,读取传感器反馈的状态数据,控制升降舵执行机构,构成双层抗扰深度跟踪控制***,实现航行器鲁棒深度跟踪航行。
Description
技术领域
本发明属于航行器自动控制领域,更具体地,涉及一种欠驱动水下航行器的双层抗扰深度跟踪控制方法及***。
背景技术
自主水下航行器在海洋调查和水下作业方面发挥着至关重要的作用,如资源勘探、海底测绘、水下打捞和海洋结构维护等。特别是欠驱动自主水下航行器,由于其结构简单和水动力性能好的优势,在勘察和搜索类任务中更是占领着重要地位。自主水下航行器的运动控制直接关系到上述任务执行的高效性和任务质量。特别是深度跟踪能力,更为必需和关键的运动能力之一。欠驱动自主水下航行器的深度跟踪控制面临着欠驱动、模型非线性、运动强耦合,外界环境干扰等困难,使得深度跟踪精度难以保证。因此,欠驱动水下自主航行器深度跟踪控制的抗扰能力显得尤为关键。
发明内容
针对现有技术的缺陷,本发明的目的在于提供一种欠驱动水下航行器的双层抗扰深度跟踪控制方法及***,旨在解决现有水下航行器在有干扰情况下的深度跟踪精度难以保证的问题。
为实现上述目的,第一方面,本发明提供了一种欠驱动水下航行器的双层抗扰深度跟踪控制方法,包括如下步骤:
确定水下航行器的航行信息;所述航行信息包括:期望深度、当前深度、当前航行速度及当前纵倾角;
根据期望深度和当前深度确定深度跟踪误差,基于自适应视线角制导律将深度跟踪误差转化为期望纵倾角;所述自适应视线角制导律包括自适应参数,以对水下航行器的真实攻角进行估计,减少忽略攻角引入的运动干扰;所述自适应参数根据当前航行速度和深度跟踪误差确定;
确定自抗扰-滑模纵倾跟踪控制律,其包括:扩展状态观测器和滑模反馈控制律;所述扩展状态观测器用于观测水下航行器的复合干扰;所述复合干扰为由航行器内部结构和外部环境引入的动力干扰总和;所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,以克服所述观测误差;
结合所述自抗扰-滑模纵倾跟踪控制律确定复合干扰的观测量和滑模反馈控制律计算的舵角,并基于所述复合干扰观测量和滑模反馈控制律计算的舵角计算升降舵的最终舵角,使得升降舵按照所述最终舵角航行,以使水下航行器按照所述期望深度稳定航行;按照所述自适应视线角制导律和自抗扰-滑模纵倾跟踪控制律计算升降舵最终舵角使得水下航行器抵抗运动干扰和动力干扰的能力提升,提高了水下航行器深度跟踪的精度。
在一个可选的示例中,所述根据期望深度和当前深度确定深度跟踪误差,基于自适应视线角制导律将深度跟踪误差转化为期望纵倾角,具体为:
将期望深度zd与当前深度z相减得到所述深度跟踪误差ez;
基于自适应视线角制导律将深度跟踪误差ez转化为期望纵倾角θd,具体包括如下公式:
式中,U为航行器的航行速度,γ为自适应增益。
在一个可选的示例中,所述扩展状态观测器用于观测水下航行器的复合干扰,具体为:
水下航行器的纵倾运动模型为:
式中,表示纵倾角加速率;表示由航行器内部结构引起的力矩对应的加速率,θ表示航行器纵倾角、表示航行器纵倾角速度、U表示航行速度、Iyy表示航行器惯性矩;dθ为外部环境干扰;b0为舵效系数,δ为最终舵角;
在一个可选的示例中,所述自抗扰-滑模纵倾跟踪控制律还包括:跟踪微分器,其用于确定所述期望纵倾角的数值微分v2和期望纵倾角的跟踪信号v1;
所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,具体为:
定义滑模面s=ce1+e2,其中,c为权重系数,e1为纵倾角跟踪误差,e1=v1-z1,e2为纵倾角速度跟踪误差,e2=v2-z2;
根据指数趋近律设计方法得出滑模反馈控制律:
式中,δ0为滑模反馈控制律计算的舵角,k参数控制着误差以指数收敛到0的速率,η为鲁棒项系数,用以克服观测误差;
通过如下公式计算v1和v2;
式中,r为跟踪加速度系数,h为计算步长,[t]表示第t步迭代计算,fhan(x1,x2,r,h)为最速控制综合函数,x1和x2为中间变量,分别表示为x1=v1[t]-θd,x2=v2[t],θd为期望纵倾角;
其中,fhan(x1,x2,r,h)通过如下公式计算:
式中,d、d0、y、a0以及a均为中间变量。
第二方面,本发明提供了一种欠驱动水下航行器的双层抗扰深度跟踪控制***,包括:
航行信息确定单元,用于确定水下航行器的航行信息;所述航行信息包括:期望深度、当前深度、当前航行速度及当前纵倾角;
期望纵倾角确定单元,用于根据期望深度和当前深度确定深度跟踪误差,基于自适应视线角制导律将深度跟踪误差转化为期望纵倾角;所述自适应视线角制导律包括自适应参数,以对水下航行器的真实攻角进行估计,减少忽略攻角引入的运动干扰;所述自适应参数根据当前航行速度和深度跟踪误差确定;
纵倾跟踪控制律确定单元,用于确定自抗扰-滑模纵倾跟踪控制律,其包括:扩展状态观测器和滑模反馈控制律;所述扩展状态观测器用于观测水下航行器的复合干扰;所述复合干扰为由航行器内部结构和外部环境引入的动力干扰总和;所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,以克服所述观测误差;
升降舵舵角确定单元,用于结合所述自抗扰-滑模纵倾跟踪控制律确定复合干扰的观测量和滑模反馈控制律计算的舵角,并基于所述复合干扰观测量和滑模反馈控制律计算的舵角计算升降舵的最终舵角,使得升降舵按照所述最终舵角航行,以使水下航行器按照所述期望深度稳定航行;按照所述自适应视线角制导律和自抗扰-滑模纵倾跟踪控制律计算升降舵最终舵角使得水下航行器抵抗运动干扰和动力干扰的能力提升,提高了水下航行器深度跟踪的精度。
在一个可选的示例中,所述期望纵倾角确定单元根据期望深度和当前深度确定深度跟踪误差,基于自适应视线角制导律将深度跟踪误差转化为期望纵倾角,具体为:将期望深度zd与当前深度z相减得到所述深度跟踪误差ez;基于自适应视线角制导律将深度跟踪误差ez转化为期望纵倾角θd,具体包括如下公式:式中,Δ为前视距离,为自适应参数;按照如下公式自适应变化:式中,U为航行器的航行速度,γ为自适应增益。
在一个可选的示例中,所述扩展状态观测器用于观测水下航行器的复合干扰,具体为:
水下航行器的纵倾运动模型为:
式中,表示纵倾角加速率;表示由航行器内部结构引起的力矩对应的加速率,θ表示航行器纵倾角、表示航行器纵倾角速度、U表示航行速度、Iyy表示航行器惯性矩;dθ为外部环境干扰;b0为舵效系数,δ为最终舵角;
在一个可选的示例中,所述自抗扰-滑模纵倾跟踪控制律还包括:跟踪微分器,其用于确定所述期望纵倾角的数值微分v2和期望纵倾角的跟踪信号v1;
所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,具体为:
定义滑模面s=ce1+e2,其中,c为权重系数,e1为纵倾角跟踪误差,e1=v1-z1,e2为纵倾角速度跟踪误差,e2=v2-z2;
根据指数趋近律设计方法得出滑模反馈控制律:
式中,δ0为滑模反馈控制律计算的舵角,k参数控制着误差以指数收敛到0的速率,η为鲁棒项系数,用以克服观测误差;
通过如下公式计算v1和v2;
式中,r为跟踪加速度系数,h为计算步长,[t]表示第t步迭代计算,fhan(x1,x2,r,h)为最速控制综合函数,x1和x2为中间变量,分别表示为x1=v1[t]-θd,x2=v2[t],θd为期望纵倾角;
其中,fhan(x1,x2,r,h)通过如下公式计算:
式中,d、d0、y、a0以及a均为中间变量。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,具有以下有益效果:
本发明提供一种欠驱动水下航行器的双层抗扰深度跟踪控制方法及***,将欠驱动水下航行器的深度跟踪分为运动学层制导和动力学层纵倾跟踪。在运动学层使用自适应视线角制导将深度误差转化为期望纵倾角,并估计和补偿攻角以抵抗真实攻角不可测引入的干扰。在此基础上,在动力学层使用自抗扰-滑模纵倾跟踪方法,使用自抗扰框架观测包括未知动力学模型和环境干扰的复合干扰,将模型补偿为统一的积分串联型,最后设计滑模控制律抵抗观测误差,计算升降舵控制舵角。上述控制方法部署于航行器艇载计算机上,读取传感器反馈的深度和纵倾角数据,控制升降舵执行机构,构成双层抗扰深度跟踪控制***,实现航行器鲁棒深度跟踪航行。
附图说明
图1为本发明实施例提供的欠驱动水下航行器的双层抗扰深度跟踪控制方法流程图;
图2为本发明实施例提供的欠驱动自主水下航行器的双层抗扰深度跟踪控制方法框图;
图3为本发明实施例提供的典型欠驱动自主水下航行器示意图;
图4a为本发明实施例提供的实艇试验的深度跟踪曲线图;
图4b为本发明实施例提供的实艇试验的纵倾跟踪和观测纵倾曲线图;
图4c为本发明实施例提供的实艇试验的纵倾角速度跟踪和观测角速度曲线图;
图4d为本发明实施例提供的实艇试验的复合干扰观测值曲线图;
图4e为本发明实施例提供的实艇试验的攻角估计值曲线图;
图5为本发明实施例提供的欠驱动水下航行器的双层抗扰深度跟踪控制***架构图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
本发明公开了欠驱动水下航行器的双层抗扰深度跟踪控制方法及***,属于自动控制领域。本发明将欠驱动水下航行器的深度跟踪分为运动学层制导和动力学层纵倾跟踪。在运动学层使用自适应视线角制导将深度误差转化为期望纵倾角,并估计和补偿攻角以抵抗真实攻角不可测引入的干扰。在此基础上,在运动学层使用自抗扰-滑模纵倾跟踪方法,使用自抗扰框架观测包括未知动力学模型和环境干扰的复合干扰,将模型补偿为统一的积分串联型,最后设计滑模控制律抵抗观测误差,计算升降舵控制舵角。上述控制方法部署于航行器艇载计算机上,读取传感器反馈的数据,控制升降舵执行机构,构成双层抗扰深度跟踪控制***,实现航行器鲁棒深度跟踪航行。
本发明设计了一种针对欠驱动自主水下航行器的双层抗扰深度跟踪控制方法,该方法将航行器的深度跟踪控制分为运动学层自适应视线角制导律和动力学层自抗扰-滑模纵倾跟踪控制律,两者分别抵抗来自运动学层和动力学层的干扰,以提高干扰下的深度跟踪精度。
可以理解的是,从本发明实际技术手段出发,显而易见地,本发明提供的水下航行器双层抗扰深度跟踪控制方法不仅适用于欠驱动自主水下航行器,还可拓展到其他类型的水下航行器控制中,本发明提供的技术手段的目的旨在提高水下航行器的深度跟踪精度,具体水下航行器的类型并不能从实质上对本发明技术方案的保护范围起任何限定作用。
图1为本发明实施例提供的欠驱动水下航行器的双层抗扰深度跟踪控制方法流程图,如图1所示,包括如下步骤:
S101,确定水下航行器的航行信息;所述航行信息包括:期望深度、当前深度、当前航行速度及当前纵倾角;
S102,根据期望深度和当前深度确定深度跟踪误差,基于自适应视线角制导律将深度跟踪误差转化为期望纵倾角;所述自适应视线角制导律包括自适应参数,以对水下航行器的真实攻角进行估计,减少忽略攻角引入的运动干扰;所述自适应参数根据当前航行速度和深度跟踪误差确定;
S103,确定自抗扰-滑模纵倾跟踪控制律,其包括:扩展状态观测器和滑模反馈控制律;所述扩展状态观测器用于观测水下航行器的复合干扰;所述复合干扰为由航行器内部结构和外部环境引入的动力干扰总和;所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,以克服所述观测误差;
S104,结合所述自抗扰-滑模纵倾跟踪控制律确定复合干扰的观测量和滑模反馈控制律计算的舵角,并基于所述复合干扰观测量和滑模反馈控制律计算的舵角计算升降舵的最终舵角,使得升降舵按照所述最终舵角航行,以使水下航行器按照所述期望深度稳定航行;按照所述自适应视线角制导律和自抗扰-滑模纵倾跟踪控制律计算升降舵最终舵角使得水下航行器抵抗运动干扰和动力干扰的能力提升,提高了水下航行器深度跟踪的精度。
如图2所示为本发明提供的双层抗扰深度跟踪控制方法框图,如图2所示:
在运动学层,自适应视线角制导律根据式(1)将深度跟踪误差ez转化为期望纵倾θd输出到纵倾跟踪控制律中。
式中,深度跟踪误差定义为期望深度zd与实际深度z之差ez=zd-z。Δ为前视距离,为人工可调参数,一般取3-5倍的航行器长度。制导律引入自适应参数对航行器真实攻角进行估计。由于真实精确攻角无法轻易获得,故现有航行器控制方法一般会忽略攻角,但忽略攻角会引起运动学层干扰,正是由于的引入使得制导律拥有抵抗运动学层干扰的能力。按照式(2)公式自适应变化。
在动力学层,使用自抗扰-滑模控制方法构建式(3)的纵倾跟踪控制律计算升降舵舵角δ。自抗扰-滑模纵倾跟踪控制律由扩展状态观测器,滑模反馈控制律和跟踪微分器组成。使用扩展状态观测器将包括内部未知模型和外部环境干扰在内的复合干扰观测出来,然后根据式(3)带入复合干扰的观测值z3将复杂的纵倾运动模型补偿为积分串联型,实现纵倾强抗扰跟踪。
式中,δ0为滑模反馈控制律计算的舵角,可进一步抵抗自抗扰的观测误差。b0为舵效系数,与航行器运动模型有关。
水下航行器的纵倾运动模型可以表示为式(4)
将观测出的复合干扰的估计值z3带入的纵倾控制律(3)中,并将(3)带入到复杂的纵倾运动模型(4)中,原复杂的被控对象将转为简单的积分串联型因此,无论内部动力学和外部环境干扰如何变化,通过使用扩张状态观测器(5)和纵倾控制律(3),原被控对象都会转化为统一的积分串联型,因此纵倾跟踪控制器具备抵抗动力学层干扰的能力。
式中,k参数控制着误差以指数收敛到0的速率,η为鲁棒项系数,用以克服观测误差。
使用跟踪微分器(7)求取期望纵倾角的数值微分v2,并得到期望纵倾角的跟踪信号v1。最后构成式(6)中误差的计算公式e1=v1-z1,e2=v2-z2。
式中,r为跟踪加速度系数,h为计算步长,[t]表示第t步迭代计算。fhan(x1,x2,r,h)为最速控制综合函数,x1和x2为中间变量,分别表示为x1=v1[t]-θd,x2=v2[t];
为了实现上述方法,本发明设计了一种针对欠驱动水下航行器的双层抗扰深度跟踪控制***。将公式(1)-(3)和(5)-(8)转化程序部署于航行器艇载计算机上,计算机调用该程序,自动读取深度传感器的深度数据z和纵倾传感器反馈的纵倾角数据θ,运行深度跟踪控制算法程序,将计算后的升降舵指令δ用以控制执行舵机,构成航行器的双层抗扰深度跟踪控制***,实现水下自主航行器干扰下的高精度鲁棒深度跟踪航行。
为验证本发明方法的深度跟踪效果和抗扰能力,使用如图3所示的一种典型的欠驱动自主水下航行器作为试验平台。该水下自主航行器在深度面运动只有推进器提供推力,升降舵提供纵倾控制力矩,控制力数量小于自由度数量,具有欠驱动特性。该平台具有深度和纵倾角反馈的能力,艉部有升降舵可以用来控制纵倾角,适合构成双层抗扰深度跟踪控制***用以验证双层抗扰深度跟踪控制方法。在该自主水下航行器的艇载计算机中编写闭环控制代码,实现自主采集传感器数据和控制升降舵功能,代码具体实现了式(1)-(3)和(5)-(8)双层抗扰深度跟踪控制方法。
期望深度首先渐变至2米,然后维持2米持续60秒,航行器运行本方法跟踪期望深度实现下潜动作,然后进行定深航行,任务结束后,航行器跟踪期望深度自主上浮。实艇试验结果见图4a-图4e。
图4a显示了航行器的深度曲线,航行器实际深度最终以无偏差收敛至期望深度2米。高精度的深度跟踪性能是由纵倾角的优异跟踪和制导律估计并补偿攻角保证的。图4b中显示了航行器的纵倾跟踪性能,可以看出航行器纵倾角可以完美地跟踪期望纵倾角。该性能是由扩张状态观测器对复合干扰的观测和补偿,滑模反馈控制律的观测误差补偿同时保证的。50秒后,航行器进行稳定航行阶段,纵倾角稳定在-1.4°。
图4b和图4c中分别显示出观测纵倾角z1收敛至实际纵倾角θ,观测角速度z2收敛至实际角速度因此可以推测,图4d显示的观测复合干扰z3也收敛至真实复合干扰正是由于扩张状态观测器能有效地对复合干扰进行估计,将复杂的纵倾运动模型补偿为积分串联型,使得实际纵倾角能无偏跟踪期望纵倾角。由于水下自主航行器一般配置为微正浮力,航行器在深度稳定后,需要一定的攻角来平衡剩余浮力。如果使用视线角制导而忽略了攻角的影响,会在运动学层引入干扰,导致深度存在稳态误差。自适应视线角制导可实时估计并补偿攻角,实时估计出的攻角见图4e,结合图4a所示,50秒后,航行器进入深度稳定航行阶段,在深度稳定航行阶段,航行器的深度保持不变,此时潜浮角为0°。65秒后的估计攻角为-1.4°,近似等于图4b所示的纵倾角,符合航行器的运动特性,从而验证了自适应视线角制导可有效地估计攻角。
图5为本发明实施例提供的欠驱动水下航行器的双层抗扰深度跟踪控制***架构图,如图5所示,包括:
航行信息确定单元510,用于确定水下航行器的航行信息;所述航行信息包括:期望深度、当前深度、当前航行速度及当前纵倾角;
期望纵倾角确定单元520,用于根据期望深度和当前深度确定深度跟踪误差,基于自适应视线角制导律将深度跟踪误差转化为期望纵倾角;所述自适应视线角制导律包括自适应参数,以对水下航行器的真实攻角进行估计,减少忽略攻角引入的运动干扰;所述自适应参数根据当前航行速度和深度跟踪误差确定;
纵倾跟踪控制律确定单元530,用于确定自抗扰-滑模纵倾跟踪控制律,其包括:扩展状态观测器和滑模反馈控制律;所述扩展状态观测器用于观测水下航行器的复合干扰;所述复合干扰为由航行器内部结构和外部环境引入的动力干扰总和;所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,以克服所述观测误差;
升降舵舵角确定单元540,用于结合所述自抗扰-滑模纵倾跟踪控制律确定复合干扰的观测量和滑模反馈控制律计算的舵角,并基于所述复合干扰观测量和滑模反馈控制律计算的舵角计算升降舵的最终舵角,使得升降舵按照所述最终舵角航行,以使水下航行器按照所述期望深度稳定航行;按照所述自适应视线角制导律和自抗扰-滑模纵倾跟踪控制律计算升降舵最终舵角使得水下航行器抵抗运动干扰和动力干扰的能力提升,提高了水下航行器深度跟踪的精度。
可以理解的是,图5中各个单元的详细功能实现可参见前述方法实施例中的介绍,在此不做赘述。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种欠驱动水下航行器的双层抗扰深度跟踪控制方法,其特征在于,包括如下步骤:
确定水下航行器的航行信息;所述航行信息包括:期望深度、当前深度、当前航行速度及当前纵倾角;
根据期望深度和当前深度确定深度跟踪误差,基于自适应视线角制导律将深度跟踪误差转化为期望纵倾角;所述自适应视线角制导律包括自适应参数,以对水下航行器的真实攻角进行估计,减少忽略攻角引入的运动干扰;所述自适应参数根据当前航行速度和深度跟踪误差确定;
确定自抗扰-滑模纵倾跟踪控制律,其包括:扩展状态观测器和滑模反馈控制律;所述扩展状态观测器用于观测水下航行器的复合干扰;所述复合干扰为由航行器内部结构和外部环境引入的动力干扰总和;所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,以克服所述观测误差;
结合所述自抗扰-滑模纵倾跟踪控制律确定复合干扰的观测量和滑模反馈控制律计算的舵角,并基于所述复合干扰观测量和滑模反馈控制律计算的舵角计算升降舵的最终舵角,使得升降舵按照所述最终舵角航行,以使水下航行器按照所述期望深度稳定航行;按照所述自适应视线角制导律和自抗扰-滑模纵倾跟踪控制律计算升降舵最终舵角使得水下航行器抵抗运动干扰和动力干扰的能力提升,提高了水下航行器深度跟踪的精度。
4.根据权利要求3所述的方法,其特征在于,所述自抗扰-滑模纵倾跟踪控制律还包括:跟踪微分器,其用于确定所述期望纵倾角的数值微分v2和期望纵倾角的跟踪信号v1;
所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,具体为:
定义滑模面s=ce1+e2,其中,c为权重系数,e1为纵倾角跟踪误差,e1=v1-z1,e2为纵倾角速度跟踪误差,e2=v2-z2;
根据指数趋近律设计方法得出滑模反馈控制律:
式中,δ0为滑模反馈控制律计算的舵角,k参数控制着误差以指数收敛到0的速率,η为鲁棒项系数,用以克服观测误差;
通过如下公式计算v1和v2;
式中,r为跟踪加速度系数,h为计算步长,[t]表示第t步迭代计算,fhan(x1,x2,r,h)为最速控制综合函数,x1和x2为中间变量,分别表示为x1=v1[t]-θd,x2=v2[t],θd为期望纵倾角;
其中,fhan(x1,x2,r,h)通过如下公式计算:
式中,d、d0、y、a0以及a均为中间变量。
6.一种欠驱动水下航行器的双层抗扰深度跟踪控制***,其特征在于,包括:
航行信息确定单元,用于确定水下航行器的航行信息;所述航行信息包括:期望深度、当前深度、当前航行速度及当前纵倾角;
期望纵倾角确定单元,用于根据期望深度和当前深度确定深度跟踪误差,基于自适应视线角制导律将深度跟踪误差转化为期望纵倾角;所述自适应视线角制导律包括自适应参数,以对水下航行器的真实攻角进行估计,减少忽略攻角引入的运动干扰;所述自适应参数根据当前航行速度和深度跟踪误差确定;
纵倾跟踪控制律确定单元,用于确定自抗扰-滑模纵倾跟踪控制律,其包括:扩展状态观测器和滑模反馈控制律;所述扩展状态观测器用于观测水下航行器的复合干扰;所述复合干扰为由航行器内部结构和外部环境引入的动力干扰总和;所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,以克服所述观测误差;
升降舵舵角确定单元,用于结合所述自抗扰-滑模纵倾跟踪控制律确定复合干扰的观测量和滑模反馈控制律计算的舵角,并基于所述复合干扰观测量和滑模反馈控制律计算的舵角计算升降舵的最终舵角,使得升降舵按照所述最终舵角航行,以使水下航行器按照所述期望深度稳定航行;按照所述自适应视线角制导律和自抗扰-滑模纵倾跟踪控制律计算升降舵最终舵角使得水下航行器抵抗运动干扰和动力干扰的能力提升,提高了水下航行器深度跟踪的精度。
9.根据权利要求8所述的***,其特征在于,所述自抗扰-滑模纵倾跟踪控制律还包括:跟踪微分器,其用于确定所述期望纵倾角的数值微分v2和期望纵倾角的跟踪信号v1;
所述滑模反馈控制律的设计过程考虑所述扩展状态观测器的观测误差,用于结合所述期望纵倾角计算水下航行器升降舵的舵角,具体为:
定义滑模面s=ce1+e2,其中,c为权重系数,e1为纵倾角跟踪误差,e1=v1-z1,e2为纵倾角速度跟踪误差,e2=v2-z2;
根据指数趋近律设计方法得出滑模反馈控制律:
式中,δ0为滑模反馈控制律计算的舵角,k参数控制着误差以指数收敛到0的速率,η为鲁棒项系数,用以克服观测误差;
通过如下公式计算v1和v2;
式中,r为跟踪加速度系数,h为计算步长,[t]表示第t步迭代计算,fhan(x1,x2,r,h)为最速控制综合函数,x1和x2为中间变量,分别表示为x1=v1[t]-θd,x2=v2[t],θd为期望纵倾角;
其中,fhan(x1,x2,r,h)通过如下公式计算:
式中,d、d0、y、a0以及a均为中间变量。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211102526.1A CN115357036B (zh) | 2022-09-09 | 2022-09-09 | 欠驱动水下航行器的双层抗扰深度跟踪控制方法及*** |
US18/324,171 US11809201B1 (en) | 2022-09-09 | 2023-05-26 | Method and system for hierarchical disturbance rejection depth tracking control of underactuated underwater vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211102526.1A CN115357036B (zh) | 2022-09-09 | 2022-09-09 | 欠驱动水下航行器的双层抗扰深度跟踪控制方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115357036A true CN115357036A (zh) | 2022-11-18 |
CN115357036B CN115357036B (zh) | 2023-03-21 |
Family
ID=84006370
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211102526.1A Active CN115357036B (zh) | 2022-09-09 | 2022-09-09 | 欠驱动水下航行器的双层抗扰深度跟踪控制方法及*** |
Country Status (2)
Country | Link |
---|---|
US (1) | US11809201B1 (zh) |
CN (1) | CN115357036B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116774715A (zh) * | 2023-05-31 | 2023-09-19 | 新兴际华(北京)智能装备技术研究院有限公司 | 水下航行器姿态控制方法及装置 |
CN117389312A (zh) * | 2023-11-07 | 2024-01-12 | 中国人民解放军海军工程大学 | 一种基于模型的水下航行器抗衡滚三维跟踪控制方法 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117806162B (zh) * | 2023-11-30 | 2024-07-12 | 同济大学 | 一种载臂无人潜航器艇-臂耦合协调控制方法及*** |
CN117627616B (zh) * | 2024-01-25 | 2024-03-26 | 中国矿业大学 | 液压锚杆钻机自适应抗扰动全局终端滑模转速控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2111891C1 (ru) * | 1996-04-23 | 1998-05-27 | Институт проблем управления РАН | Система стабилизации судна |
CN101419464A (zh) * | 2008-06-13 | 2009-04-29 | 哈尔滨工程大学 | 一种采用矢量推进器的无人潜水器定深航行控制方法 |
CN102385316A (zh) * | 2011-09-16 | 2012-03-21 | 哈尔滨工程大学 | 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法 |
CN103064422A (zh) * | 2012-11-23 | 2013-04-24 | 中国科学院沈阳自动化研究所 | 一种无缆自治水下航行体的悬停控制方法 |
CN103412567A (zh) * | 2013-04-15 | 2013-11-27 | 上海大学 | 基于线性自抗扰技术的水下机器人深度控制装置和方法 |
CN106444796A (zh) * | 2016-10-08 | 2017-02-22 | 哈尔滨工程大学 | 一种不确定时变时滞的欠驱动uuv深度自适应全局滑模控制方法 |
CN109507885A (zh) * | 2018-12-20 | 2019-03-22 | 中国海洋大学 | 基于自抗扰的无模型自适应auv控制方法 |
CN113479304A (zh) * | 2021-06-18 | 2021-10-08 | 华中科技大学 | 多舵面水下拖曳式航行器的平行潜浮与相对潜浮一体化深度控制***及方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6482059B2 (en) * | 1997-05-09 | 2002-11-19 | Mccarthy Peter T. | High efficiency hydrofoil and swim fin designs |
US10747226B2 (en) * | 2013-01-31 | 2020-08-18 | Flir Systems, Inc. | Adaptive autopilot control systems and methods |
US9487282B2 (en) * | 2014-04-08 | 2016-11-08 | Mrv Systems, Llc | Underwater vehicles configured to perform vertical profiling and diagonal profiling, and corresponding methods of operation |
US20180065744A1 (en) * | 2016-09-06 | 2018-03-08 | Young Chan Park | Submarine and flying automobile |
US20210261226A1 (en) * | 2017-06-16 | 2021-08-26 | FLIR Belgium BVBA | Polar mapping for autonomous and assisted docking systems and methods |
US20210269128A1 (en) * | 2017-06-16 | 2021-09-02 | FLIR Belgium BVBA | Assisted docking graphical user interface systems and methods |
US10882591B2 (en) * | 2017-11-03 | 2021-01-05 | Aquaai Corporation | Modular biomimetic underwater vehicle |
US20220145756A1 (en) * | 2020-11-09 | 2022-05-12 | Alessandro Vagata | Seafloor Harvesting With Autonomous Drone Swarms |
-
2022
- 2022-09-09 CN CN202211102526.1A patent/CN115357036B/zh active Active
-
2023
- 2023-05-26 US US18/324,171 patent/US11809201B1/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2111891C1 (ru) * | 1996-04-23 | 1998-05-27 | Институт проблем управления РАН | Система стабилизации судна |
CN101419464A (zh) * | 2008-06-13 | 2009-04-29 | 哈尔滨工程大学 | 一种采用矢量推进器的无人潜水器定深航行控制方法 |
CN102385316A (zh) * | 2011-09-16 | 2012-03-21 | 哈尔滨工程大学 | 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法 |
CN103064422A (zh) * | 2012-11-23 | 2013-04-24 | 中国科学院沈阳自动化研究所 | 一种无缆自治水下航行体的悬停控制方法 |
CN103412567A (zh) * | 2013-04-15 | 2013-11-27 | 上海大学 | 基于线性自抗扰技术的水下机器人深度控制装置和方法 |
CN106444796A (zh) * | 2016-10-08 | 2017-02-22 | 哈尔滨工程大学 | 一种不确定时变时滞的欠驱动uuv深度自适应全局滑模控制方法 |
CN109507885A (zh) * | 2018-12-20 | 2019-03-22 | 中国海洋大学 | 基于自抗扰的无模型自适应auv控制方法 |
CN113479304A (zh) * | 2021-06-18 | 2021-10-08 | 华中科技大学 | 多舵面水下拖曳式航行器的平行潜浮与相对潜浮一体化深度控制***及方法 |
Non-Patent Citations (3)
Title |
---|
CAOYANG YU 等: "An experimental study of adaptive bounded depth control for underwater vehicles subject to thruster’s dead-zone and saturation" * |
于曹阳 等: "基于反步法的欠驱动水下机器人鲁棒定深控制" * |
向先波 等: "基于联合操舵的水下航行器幂次滑模定深控制" * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116774715A (zh) * | 2023-05-31 | 2023-09-19 | 新兴际华(北京)智能装备技术研究院有限公司 | 水下航行器姿态控制方法及装置 |
CN116774715B (zh) * | 2023-05-31 | 2024-06-07 | 新兴际华(北京)智能装备技术研究院有限公司 | 水下航行器姿态控制方法及装置 |
CN117389312A (zh) * | 2023-11-07 | 2024-01-12 | 中国人民解放军海军工程大学 | 一种基于模型的水下航行器抗衡滚三维跟踪控制方法 |
CN117389312B (zh) * | 2023-11-07 | 2024-05-28 | 中国人民解放军海军工程大学 | 一种基于模型的水下航行器抗横滚三维跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
US11809201B1 (en) | 2023-11-07 |
CN115357036B (zh) | 2023-03-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115357036B (zh) | 欠驱动水下航行器的双层抗扰深度跟踪控制方法及*** | |
CN110597069B (zh) | 一种基于rbf神经网络的水下机器人自适应区域动力定位控制方法 | |
US20170300056A1 (en) | Proactive directional control systems and methods | |
CN101833338B (zh) | 无人潜航器垂直面欠驱动运动控制方法 | |
CN100589055C (zh) | 基于递归模糊神经网络的水下潜器空间变结构控制方法 | |
CN109358504B (zh) | 基于自适应积分鲁棒的四旋翼轨迹/姿态复合抗干扰跟踪控制方法 | |
Corno et al. | Data-driven online speed optimization in autonomous sailboats | |
CN111547212B (zh) | 一种无动力式快速潜浮auv的浮力控制方法 | |
CN115515851A (zh) | 船舶的自动导向方法、船舶的自动导向程序、船舶的自动导向***及船舶 | |
CN115826625B (zh) | 一种针对水下探测任务的无人机协调转弯飞行方法 | |
CN113467231A (zh) | 基于侧滑补偿ilos制导律的无人艇路径跟踪方法 | |
CN109521798B (zh) | 基于有限时间扩张状态观测器的auv运动控制方法 | |
CN111026135A (zh) | 一种无人艇高性能航行前馈控制***及其控制方法 | |
CN114967714A (zh) | 一种自主式水下机器人抗扰运动控制方法及*** | |
CN114967702A (zh) | 一种无人艇控制***及路径跟踪方法 | |
CN106527454A (zh) | 一种无稳态误差的远程水下航行器定深控制方法 | |
CN113296511A (zh) | 基于漂角补偿和改进超螺旋算法的船舶航向控制方法 | |
CN112925332A (zh) | 无人艇与水下无人潜器联合***的协同交会对接控制方法 | |
Kurowski et al. | Generic navigation and control methods for classes of unmanned surface vehicles | |
CN113625725B (zh) | 一种水面无人艇路径跟踪控制方法 | |
CN115686034A (zh) | 考虑速度传感器失效的无人潜航器轨迹跟踪控制方法 | |
Yang et al. | A SINS/DVL integrated navigation positioning method based on improved adaptive filtering technology | |
Moe et al. | Path following of underactuated marine underwater vehicles in the presence of unknown ocean currents | |
CN112416005A (zh) | 基于领航者策略的多模块船自抗扰动态面协同控制方法 | |
Watanabe et al. | Development of track control system utilizing heading control system for ocean observation sailing |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |