[发明专利]欠驱动水面机器人的水动力系数混合自适应估计方法

说明书

本发明公开了一种欠驱动水面机器人的水动力系数混合自适应估计方法。获取物理参数，建立性动力学模型；建立水域流场的网格划分模型，且划分为网格；仿真获得横荡力曲线和艏摇力矩曲线，利输入线性动力学模型拟合得水动力系数；以水动力系数向量作为迭代过程中的初始值并设置自适应范围，通过水池试验获得给定推力下的姿信息，处理获得速度向量的估计值向量，计算辅助误差向量，建立参数自适应率公式获得估计值向量；重复步骤迭代循环，直至水池试验获得位姿信息均迭代循环处理过。本发明结果更逼近真实值，充分考虑了测量噪声及外界干扰的影响，更加符合测量实际，避免了对速度求导所造成的加速度信息精度低的问题。

技术领域

本发明涉及一种水面机器人测试估计方法，尤其涉及一种欠驱动水面机器人的水动力系数估计方法。

背景技术

随着世界经济的飞速发展和人口的不断增加，人类消耗的自然资源越来越多，陆地上的资源正逐渐减少。海洋不仅仅作为一种交通运输通道存在，更重要的是它能从一定程度上缓解人类的资源危机。海洋里蕴藏着丰富的矿产资源，海洋的探测也具有极强的吸引力、挑战性。随着海洋探测的日益增多，欠驱动水面机器人被越来越广泛应用于海洋的探索、监测及救援中。欠驱动水面机器人水动力参数的获取成为了其实现水下目标跟踪、轨迹跟随控制的基础与关键。

然而，欠驱动水面机器人的形状一般不规则，故传统的水动力系数经验公式大多难以适用。而在基于CFD的水动力系数获取方法中，程序的编写和网格的划分很大程度上依赖于经验与技巧，故该方法的精度有待提高。约束船模实验法需要小型水面救援机器人设置有相应的测试安装机构，且对测试仪器有更高的要求，因此需要的经费投入更高。支持向量机、神经网络等方法前期需要大量的实船实验以获取数据进行训练，需要较长的实验时间和计算时间。最小二乘法受参数初始给定值影响较大，需要得到准确的角加速度数值，且不能保证速度估计误差收敛。

传统的参数自适应法没有考虑存在外界干扰和测量噪声的情况，现有实验所得到的水动力导数难以达到真实值附近的精度，并不准确。

发明内容

本发明要解决的技术问题设计一种针对欠驱动水面机器人的水动力导数估计方式，该方法考虑实验过程中外界干扰和测量噪声，且不需要得到角加速度的具体信息，最终得到的水动力导数接近真实值且广义速度的预测误差可以收敛到0，达到准确的精度，避免了对速度求导所造成的加速度信息精度低的问题。

本发明采用的技术方案如下：

(1)获取水面机器人的物理参数，根据水面机器人的物理参数建立水面机器人的线性动力学模型；

(2)针对水面机器人，建立水域流场的网格划分模型，且划分为纯纵横荡结构网格和纯艏摇结构网格；

(3)将步骤(2)中划分的纯纵横荡结构网格和纯艏摇结构网格进行纯纵荡、纯横荡和纯艏摇的仿真，仿真时获得横荡力曲线和艏摇力矩曲线，利用横荡力曲线和艏摇力矩曲线输入到步骤(1)的线性动力学模型中拟合得到X_u、Y_v、Y_r、N_v、N_r、的10个水动力系数；

由10个水动力系数组建水动力系数向量θ中，水动力系数向量θ中有10个元素，10个元素依次为θ₁、θ₂、θ₃、θ₄、θ₅、θ₆、θ₇、θ₈、θ₉和θ₁₀，其中，θ₆＝X_u，θ₇＝Y_v，θ₈＝Y_r，θ₉＝N_v，θ₁₀＝N_r；