一种AUV水平面欠驱动下的定点控位方法
本发明一般涉及auv自主运动控制领域,并且更具体地,涉及一种auv水平面欠驱动下的定点控位方法。
背景技术:
1、目前,水下无人航行器(auv,autonomous underwater vehicle)是水下目标探测、水文观测、深海地形测量等各领域使用的主要载体和手段。伴随着任务需求的多样性、复杂性提升,对auv的任务载荷、整体结构布置等提出了更加苛刻的设计需求,因此,在必要情况下,将以牺牲常规化的整体结构布置为代价,进行非常规auv结构设计。
2、在auv设计输入中,通常会对auv的质量、尺寸、续航力、任务能力等提出明确的指标,而当出现auv内部置空率达到瓶颈时仍无法满足设计输入状况时,则需要对某非极必要或存在可替代方案的结构部分进行裁剪。在中小型auv结构中,辅助推进器一般呈贯穿式,在大型auv结构中,辅助推进器有贯穿式和同轴对称式双辅助推进器两种方式,该结构使auv结构丢失了很大的一部分有效可利用空间,为达到预设目标,则辅助推进器将优先成为被裁剪的结构对象。
3、但是,当某一常规辅助推进器结构设计被裁剪后,该部分本该具备的功能完成情况将面临重大挑战。辅助推进器一般用于涉及auv悬停控位的任务中,而悬停控位作为航行控制技术中重要构成部分,其控制精度将直接影响精细操作、定点监测、静默潜伏探测等任务的执行结果。单auv水平辅助推进器裁剪后,导致的auv在水平面内不具备全驱动定点控位能力,针对该问题,本发明设计了一种auv水平面欠驱动下的定点控位方法,通过求取水流信息,在不同区域内进行不同的运动控制策略,使auv在欠驱动模式下,仍可以抗衡外界综合扰动力的干扰,达到平衡状态,实现长时间、高精度的稳定定点控位作业任务。
技术实现思路
1、根据本发明,提供了一种auv水平面欠驱动下的定点控位方案。本方案在总体任务约束情况下进行auv水平面欠驱动结构设计时,使auv仍具备一种可用于执行精细操作、定点监测、静默潜伏探测等任务的auv定点控位方法能力。可针对不同型号auv推进器分布、不同水域情况,按本发明设计思路,动态切换转艏控制、侧移控制模式,快速、低能耗、稳定的完成定点控位功能,实现长时间、高精度的稳定定点控位作业任务。
2、本发明提供了一种auv水平面欠驱动下的定点控位方法。该方法包括:
3、获取auv运动状态数据和目标位置;其中,所述auv运动状态数据包括:auv回转半径、auv航速和auv位置;
4、构建水流速度线性观测模型;利用所述水流速度线性观测模型,估计区域内水流信息;
5、计算auv从auv航速降速至零速的刹车距离;再根据刹车距离和auv回转半径,计算距离切换阈值;
6、基于auv位置和目标位置,计算目标距离;
7、若目标距离大于距离切换阈值,则根据区域内水流信息、auv位置、auv回转半径和距离切换阈值,采用航向闭环方式控制auv航行;否则采用位置闭环方式,控制auv进行定点悬停控位。
8、进一步地,所述利用所述水流速度线性观测模型,估计区域内水流信息,包括:
9、采用最小二乘法对所述水流速度线性观测模型进行求解,得到向东水流速度和向北水流速度;
10、根据向东水流速度和向北水流速度的均值,计算水流流向信息。
11、进一步地,所述水流速度线性观测模型为:
12、
13、
14、
15、
16、其中,为测量数据矩阵;为待估计矩阵;为转换矩阵,为auv的纵倾角;为auv的航向角;为auv的横滚角;为auv在运动坐标系下对底右向速度;为转换矩阵;为水流在大地坐标系下北向速度;为水流在大地坐标系下东向速度;为auv在运动坐标系下对流前向速度;为auv在运动坐标系下对流右向速度。
17、进一步地,距离切换阈值的计算公式为:
18、
19、其中,为距离切换阈值;为第一距离系数;为刹车距离;为第二距离系数;为auv回转半径。
20、进一步地,所述根据区域内水流信息、auv位置、auv回转半径和距离切换阈值,采用航向闭环方式控制auv航行,包括:
21、根据区域内水流信息、auv回转半径和距离切换阈值,计算缓冲位置;
22、将auv位置和缓冲位置之间的距离作为缓冲距离;
23、利用los获取目标航向;
24、预设缓冲距离阈值;若所述缓冲距离小于缓冲距离阈值,则控制auv向目标航向行进。
25、进一步地,所述控制auv向目标航向行进,包括:
26、利用los算法对auv进行航向闭环,得到水平面转艏控制量期望值;
27、根据所述水平面转艏控制量期望值,求解螺旋桨转速;
28、基于螺旋桨转速,控制auv向目标航向行进。
29、进一步地,航向闭环公式为:
30、
31、其中,为水平面转艏控制量期望值;为航向pid控制中比例系数;为水平角速度误差;为航向pid控制中积分系数;为水平角速度误差积分;为航向pid控制中微分系数;为水平角速度微分;为auv在运动坐标系下中心位置的轴坐标值。
32、进一步地,所述采用位置闭环方式,控制auv进行定点悬停控位,包括:
33、利用pid算法对auv进行位置闭环,得到水平面侧移控制量期望值;
34、根据所述水平面侧移控制量期望值,求解螺旋桨转速;
35、基于螺旋桨转速,控制auv进行定点悬停控位。
36、进一步地,所述位置闭环的公式为:
37、
38、其中,为水平面侧移控制量期望值;为水平面位置pid控制中比例系数;为右向速度误差;为水平面位置pid控制中积分系数;为右向速度误差积分;为水平面位置pid控制中微分系数;为右向速度微分。
39、进一步地,所述螺旋桨转速的求解公式为:
40、
41、其中,为航向螺旋桨转速;为螺旋桨直径;为流体密度;为力矩系数;为输入的控制量期望值。
42、与现有技术相比,本发明具有如下有益的技术效果:
43、1.本发明的方法能够使欠驱动auv具备一种可用于执行精细操作、定点监测、静默潜伏探测等任务的auv定点控位方法的能力。可针对不同型号auv推进器分布、不同水域情况,按本发明设计思路,动态切换转艏控制、侧移控制模式,快速、低能耗、稳定的完成定点控位功能,实现长时间、高精度的稳定定点控位作业任务。具有普适性强、安全风险低、转化简单、稳定性强等优点。
44、2.本发明的方法,计算速率快、资源占用少,能够在实际任务中高频率的实时输出控制分配值,通过auv辅助推进器螺旋桨的快速响应,实现该自由度的控制快速闭环,达到高精度定点控位目的,具有良好的实时性和鲁棒性。
45、应当理解, 技术实现要素: 部分中所描述的内容并非旨在限定本发明的实施例的关键或重要特征,亦非用于限制本发明的范围。本发明的其它特征将通过以下的描述变得容易理解。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com