一种基于参数辨识的无人艇自适应控制方法

本发明涉及无人艇的纵向推进、速度控制领域，具体而言，涉及一种基于参数辨识的无人艇自适应控制方法。

背景技术：

1、无人艇的纵向推进与速度控制传统上一般采用误差反馈以及等效控制结构补偿的方式，因此在工程设计中需要知道无人艇的结构尺寸等精确信息，以及转动惯量等质量分布信息，然后进行结构补偿。由于无人艇模型存在较多的非线性以及耦合影响，因此上述模型结构参数的精确获取是比较困难的，以及无人艇在水面运行过程中受到的风浪干扰影响，因此模型参数总是存在不确定性，因此靠预先知道结构信息来进行精确补偿的思想在实际工程中是难以完全实现的，总有部分不确定性导致部分结构信息难以被完全补偿，从而造成速度控制的平稳性、抗干扰能力、以及精确性均存在一定的不足。基于上述背景原因，本发明以及参数辨识的思想，采用两种自适应的方法是无人艇的结构干扰信息进行自适应辨识补偿，并结构反馈控制的思想，提出了一种自适应控制方法，实现了无人艇纵向推进速度的精确反馈抗干扰控制，也使得本发明具有很高的工程应用推广价值。

2、需要说明的是，在上述背景技术部分发明的信息仅用于加强对本发明的背景的理解，因此可以包括不构成对本领域普通技术人员已知的现有技术的信息。

技术实现思路

1、本发明的目的在于提供一种基于参数辨识的无人艇自适应控制方法，进而克服了由于无人艇结构与干扰信息不确定导致的无人艇速度控制平稳性与动态性能不足的问题。

2、根据本发明的一个方面，提供一种基于参数辨识的无人艇自适应控制方法，包括以下四个步骤：

3、步骤s10，在无人艇上安装惯性导航设备，测量无人艇的纵荡速度信号与艏摇角速度信号，并根据无人艇任务，设置无人艇的期望纵荡速度信号，进行比较后得到无人艇的纵荡速度误差信号；再根据纵荡速度误差信号进行组合非线性变换，得到纵荡速度误差非线性信号；然后根据纵荡速度误差非线性信号通过惯性延迟环节，得到速度常值干扰惯性自适应估计信号；并根据纵荡速度误差非线性信号与纵荡速度误差信号设计速度常值干扰迭代自适应速率信号；然后再进行积分迭代，得到速度常值干扰迭代自适应估计信号；然后叠加速度常值干扰惯性自适应估计信号得到速度常值干扰参数自适应辨识总信号。

4、步骤s20，根据所述的纵荡速度误差非线性信号、无人艇的纵荡速度信号与艏摇角速度信号，通过惯性延迟环节，得到平动转动耦合干扰惯性自适应估计信号；再根据所述的纵荡速度误差信号、纵荡速度误差非线性信号、无人艇的纵荡速度信号与艏摇角速度信号进行非线性组合，得到平动转动耦合干扰迭代自适应速率信号，再进行积分迭代，得到平动转动耦合干扰迭代自适应估计信号；然后叠加平动转动耦合干扰惯性自适应估计信号得到平动转动耦合干扰参数自适应辨识总信号。

5、步骤s30，根据所述的纵荡速度误差非线性信号、无人艇的纵荡速度信号通过惯性延迟环节，得到平动干扰惯性自适应估计信号；再根据所述的纵荡速度误差信号、纵荡速度误差非线性信号、无人艇的纵荡速度信号与艏摇角速度信号进行非线性组合，得到平动干扰迭代自适应速率信号，再进行积分迭代，得到平动干扰迭代自适应估计信号；然后叠加平动干扰惯性自适应估计信号得到平动干扰参数自适应辨识总信号。

6、步骤s40，根据所述的纵荡速度误差信号与的纵荡速度误差非线性信号进行组合积分，得到速度误差组合积分信号；然后根据所述的速度常值干扰惯性自适应估计信号与纵荡速度误差非线性信号，求解速度误差近似微分信号；最后根据所述的速度常值干扰参数自适应辨识总信号、平动转动耦合干扰参数自适应辨识总信号以及平动干扰参数自适应辨识总信号叠加纵荡速度误差信号、速度误差组合积分信号以及速度误差近似微分信号，得到最终的纵荡推进力信号，输送给无人艇推进系统，实现对无人艇期望速度的精确跟踪控制。

7、在本发明的一种示例实施例中，根据无人艇任务，设置无人艇的期望纵荡速度信号，进行比较后得到无人艇的纵荡速度误差信号；再根据纵荡速度误差信号进行组合非线性变换，得到纵荡速度误差非线性信号；然后根据纵荡速度误差非线性信号通过惯性延迟环节，得到速度常值干扰惯性自适应估计信号；并根据纵荡速度误差非线性信号与纵荡速度误差信号设计速度常值干扰迭代自适应速率信号；然后再进行积分迭代，得到速度常值干扰迭代自适应估计信号；然后叠加速度常值干扰惯性自适应估计信号得到速度常值干扰参数自适应辨识总信号包括：

8、e1＝u-ud；

9、

10、

11、

12、c0b(n+1)＝c0b(n)+cd0bt；

13、

14、其中u为无人艇的纵荡速度信号，r为无人艇的艏摇角速度信号；ud为无人艇的期望纵荡速度信号；e1为无人艇的纵荡速度误差信号；s为惯性延迟环节传递函数的微分算子；ea1为纵荡速度误差非线性信号；l11、l12与ε1为非线性变换的常值参数；t1为惯性延迟环节的时间参数，为常数；c0a为速度常值干扰惯性自适应估计信号；cd0b为速度常值干扰迭代自适应速率信号；c0b为速度常值干扰迭代自适应估计信号，l13、l14为常值参数信号，用于调节自适应迭代的速度快慢；t为迭代周期参数，为常值；为速度常值干扰参数自适应辨识总信号。

15、在本发明的一种示例实施例中，根据所述的纵荡速度误差非线性信号、无人艇的纵荡速度信号与艏摇角速度信号，通过惯性延迟环节，得到平动转动耦合干扰惯性自适应估计信号；再根据所述的纵荡速度误差信号、纵荡速度误差非线性信号、无人艇的纵荡速度信号与艏摇角速度信号进行非线性组合，得到平动转动耦合干扰迭代自适应速率信号，再进行积分迭代，得到平动转动耦合干扰迭代自适应估计信号；然后叠加平动转动耦合干扰惯性自适应估计信号得到平动转动耦合干扰参数自适应辨识总信号包括：

16、

17、

18、c1b(n+1)＝c1b(n)+cd1bt；

19、

20、其中c1a为平动转动耦合干扰惯性自适应估计信号；cd1b为平动转动耦合干扰迭代自适应速率信号，c1b为平动转动耦合干扰迭代自适应估计信号；为平动转动耦合干扰参数自适应辨识总信号；l23、l24为常值参数信号，用于调节自适应迭代的速度快慢。

21、在本发明的一种示例实施例中，根据所述的纵荡速度误差非线性信号、无人艇的纵荡速度信号通过惯性延迟环节，得到平动干扰惯性自适应估计信号；再根据所述的纵荡速度误差信号、纵荡速度误差非线性信号、无人艇的纵荡速度信号与艏摇角速度信号进行非线性组合，得到平动干扰迭代自适应速率信号，再进行积分迭代，得到平动干扰迭代自适应估计信号；然后叠加平动干扰惯性自适应估计信号得到平动干扰参数自适应辨识总信号包括：

22、

23、

24、c2b(n+1)＝c2b(n)+cd2bt；

25、

26、其中c2a为平动干扰惯性自适应估计信号；cd2b为平动干扰迭代自适应速率信号，c2b为平动干扰迭代自适应估计信号；为平动干扰参数自适应辨识总信号；l33、l34为常值参数信号，用于调节平动干扰自适应迭代的速度快慢。

27、在本发明的一种示例实施例中，根据所述的纵荡速度误差信号与的纵荡速度误差非线性信号进行组合积分，得到速度误差组合积分信号；然后根据所述的速度常值干扰惯性自适应估计信号与纵荡速度误差非线性信号，求解速度误差近似微分信号；最后根据所述的速度常值干扰参数自适应辨识总信号、平动转动耦合干扰参数自适应辨识总信号以及平动干扰参数自适应辨识总信号叠加纵荡速度误差信号、速度误差组合积分信号以及速度误差近似微分信号，得到最终的纵荡推进力信号包括：

28、s1＝∫(e1+ls1e1a)dt；

29、

30、

31、其中s1为速度误差组合积分信号；ls1为常值参数；e1d为速度误差近似微分信号；τu为纵荡推进力信号，k1、k2、k3为常值控制参数。

32、有益效果

33、本发明提供了一种基于参数辨识的无人艇自适应控制方法，其主要创新点有如下三点。第一是在无人艇结构与干扰参数未知或不确定的情况下，采用自适应参数辨识的方式，完成了速度精确高性能的反馈闭环控制，解决了传统方法需要无人艇结构与干扰的相关准确信息的问题，也可供了速度控制的抗干扰能力。第二是将干扰参数分为常值干扰、平动转动耦合干扰、以及平动干扰三大类的方式，能够很好的吻合无人艇的结构不确定模型特点，具有简单明了，物理意义明确，而且自适应参数辨识器构建的复杂度较低，便于工程实现与参数调整。第三是按照惯性延迟与积分迭代两种方式相结合的方法进行组合参数辨识，有效地避免的参数发散问题。同时，最终与反馈控制相结合，又能够合理利用反馈控制的优点，得到了较好的速度复合控制效果。

34、应当理解的是，以上的一般描述和后文的细节描述仅是示例性和解释性的，并不能限制本发明。