本发明属于无人艇自主靠泊运动控制领域，具体涉及面向无人艇自主靠泊的运动控制方法。
背景技术：
无人艇是一种非线性的欠驱动控制系统，在自主靠泊时不仅面临着较大的环境干扰，还要受到因速度低导致的舵效差、因岸壁效应导致的扰动大等不利影响，因此对无人艇的自主靠泊控制是无人艇自动控制领域的一大难题。
公开日2017年7月21日，公开号CN106970636A，发明名称为“一种用于控制飞行器速率的控制系统及其控制方法”的专利申请用于控制飞行器速率，其控制系统包含常规PID控制器、模糊PID控制器和权重分配模块，其中的权重分配模块根据实际飞行环境对常规PID控制器和模糊PID控制器进行权重分配，实现二者的有效结合，在常态飞行时能够保证飞行的稳定性，在突发情况时能够提高自适应性。
但是飞行器的动力学特性及其所处工作环境与无人艇都显著不同，因此该方法不适用于无人艇的运动控制。
公开日2013年1月9日，公开号CN202663351U，发明名称为“基于模糊自适应PID控制器的伺服电机转速控制系统”的专利申请，系统包括位置模糊自适应PID控制器、速度模糊自适应PID控制器和电流模糊自适应PID控制器，响应快，超调少，精度高，参数自适应能力强，具有较好的抗干扰性和动态特性。
但该控制系统把电机作为研究对象，没有考虑无人艇动态靠泊行为变化的影响，在控制方法上同样缺乏针对性，无法直接应用于无人艇系统在低航速、环境力扰动下的高精度控制。
文献“基于模糊PID的水下机器人运动控制”中，尹梦舒等人提出一种基于模糊PID的控制器来解决水下机器人的纵向潜浮运动控制问题，同时在WEBOTS仿真环境中进行了仿真测试，并进行了真实环境的试验验证。
该方法虽然经过了试验验证，但是水下机器人做潜浮运动的工作环境相对无人艇的自主靠泊任务较为稳定，环境扰动较小；且该方法无法根据机器人工作时的具体情况对控制参数进行自适应在线调整，因此难以直接应用于无人艇的自主靠泊控制中。
总而言之，无人艇自主靠泊控制的难点在于：(1)在自主靠泊过程的远码头阶段，无人艇航速较高，此时如果不能保证控制器的稳定性和实时性，就无法在有限的时间内对无人艇的航速、航向进行有效控制，最终导致靠泊任务失败甚至发生事故。(2)而在码头末端的近岸阶段，无人艇的航速与航向则要尽可能地避免出现“超调”现象。对于航速而言，码头末端航速很低，假如出现超调，容易引起较大的轨迹跟踪误差(即实际轨迹震荡)，进而导致期望艏向出现“180度大反转”的现象；对于航向而言，由于航速低导致舵效差，航向一旦超调，在极其有限的空间内难以进行艏向修正；而且泊位一般距离岸边很近，艏向超调易于导致无人艇撞上码头，发生事故。而传统的PID控制器是一种基于离线数据的数据驱动控制算法，无法根据实际情况进行在线调整，其运动控制性能难以保证。
技术实现要素：
本发明的目的在于提供一种分别针对不同的控制要求对模糊控制器的参数进行在线自适应调节的面向无人艇自主靠泊的运动控制方法。
本发明的目的通过如下技术方案来实现：
面向无人艇自主靠泊的运动控制方法，包括以下步骤：
(1)由系统获取当前的期望速度u_expect(t)和当前的实际速度u_actual(t)，利用公式
计算出实际速度与期望速度之间的偏差e和偏差率其中t为控制器的步长，转步骤(2)；
(2)判断当前期望速度u_expect(t)是否大于阈值u，是则选用远端模糊规则，否则选用近岸模糊规则，转步骤(3)；
其中阈值u根据LOS视距制导法获得，即u＝f(Δr)其中Δr是用来调整无人艇航速的因数，无人艇在与最终目标点接近的过程中，航速的控制模型定义为下式：
式中：Vt表示无人艇t时刻的速度大小，r表示无人艇到目标点的视线距离，假设Δr取5，表示速度Vt下降为0.5米每秒时无人艇距离目标点的距离为5米。
当r足够大，即无人艇距离目标点较远时，Vt基本上等于Vmax，所以将此时定义为远端阶段，而当r逐渐下降到与Δr在同一量级时，Vt越来越小直至减小到0，此阶段定义为近岸阶段，本发明令阈值u等于0.8m/s。
(3)根据步骤(2)中选取的模糊规则，将步骤(1)中得到的偏差e和偏差率作为模糊规则输入，经过模糊化，模糊调整和解模糊后输出PID控制参数改变量ΔKp,ΔKi,ΔKd，利用公式
更新Kp,Ki,Kd参数，式中K'p,K'i,K'd为上一个控制节拍下的控制参数，转步骤(4)；
(4)将偏差e和新的控制参数带入PID控制器，解算出所需的推进器电机电压值输出给电机，返回步骤(1)；
本发明将e，ΔKp，ΔKi，ΔKd的模糊论域均定义为{-6,-5,-4,-3,-2,-1,0,1,2,3,4,5,6}，为了确保模糊控制器的精度要求，将控制器输入、输出都划分为七档{NB，NM，NS，ZO，PS，PM，PB}，分别表示负大、负中、负小、零、正小、正中、正大，模糊隶属度函数选择应用较为普遍的三角型隶属度函数，采用面积中心平均法作为解模糊化的方法。
①远端模式模糊规则的确定
根据以上的参数整定原则，采用MAMDANI推理模型，同时结合输入/输出变量以及隶属度曲线的确定，分析人的实际丰富操纵经验可以产生如下一系列的航向、航速控制规则语言：
If e is NB andis NB,then u is PB
......
If e is PB andis PB,then u is NB
得到调整Kp，Ki，Kd三个参数的修正量ΔKp，ΔKi，ΔKd的模糊规制表。
②近岸模式规则表的确定
在控制系统中，响应速度慢是影响系统性能的一个主要因素，但是对于无人艇靠泊过程中对码头末端速度和航向的控制，快速响应相对于超调来说就没那么重要。
因此从限制超调现象出现出发，尽可能的使无人艇航向、航速快速响应，得到调整Kp，Ki，Kd三个参数的修正量ΔKp，ΔKi，ΔKd的模糊规制表。
本发明的有益效果在于：
本发明针对无人艇自主靠泊时的运动控制问题，将控制器分成两种模式，分别针对不同的控制要求对模糊控制器的参数进行在线自适应调节，在靠泊过程的远端阶段具有良好的稳定性和实时性，而在靠泊过程的近岸阶段又具有较强的鲁棒性并能够有效地防止超调，从而实现对无人艇自主靠泊的有效控制，该控制方法在仿真和试验下均得到了有效验证。
附图说明
图1为无人艇运动控制系统框图；
图2为运动控制流程图；
图3为通过视线距离控制速度曲线图；
图4为自适应改进模糊PID控制器结构图。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步说明：
结合图1，向无人艇传递控制期望值即[Ψq]，利用惯导测得无人艇当前的实际值[Ψmh]，计算误差绝对值e(k)，作为自适应改进模糊PID控制器的输入，并由控制器解算出期望指令u(k)(期望电压或期望转速或期望推力)本发明以期望电压为例，无人艇动力机构接收并执行期望电压指令，从而改变无人艇运动状态，并通过惯导测得下一时刻无人艇的航速或航向，与期望值做差并取绝对值，并作为自适应改进模糊PID控制器下一时刻的输入。同时考虑到环境干扰对无人艇运动控制的影响，重复上述过程直到无人艇稳定到期望状态。
结合图2，表述了本发明的控制系统流程图，具体实现步骤如下：
(1)由系统获取当前的期望速度u_expect(t)和当前的实际速度u_actual(t)，利用公式
计算出实际速度与期望速度之间的偏差e和偏差率其中t为控制器的步长，转步骤(2)；
(2)判断当前期望速度u_expect(t)是否大于阈值u，是则选用远端模糊规则，否则选用近岸模糊规则，转步骤(4)；
其中阈值u根据LOS视距制导法获得，即u＝f(Δr)其中Δr是用来调整无人艇航速的因数，无人艇在与最终目标点接近的过程中，航速的控制模型定义为下式：
式中：Vt表示无人艇t时刻的速度大小，r表示无人艇到目标点的视线距离，如图3所示速度曲线图，假设Δr取5，表示速度Vt下降为0.5米每秒时无人艇距离目标点的距离为5米。
当r足够大，即无人艇距离目标点较远时，Vt基本上等于Vmax，所以将此时定义为远端阶段，而当r逐渐下降到与Δr在同一量级时，Vt越来越小直至减小到0，此阶段定义为近岸阶段，本发明令阈值u等于0.8m/s。
(3)根据步骤(2)中选取的模糊规则，将步骤(1)中得到的偏差e和偏差率作为模糊规则输入，经过模糊化，模糊调整和解模糊后输出PID控制参数改变量ΔKp,ΔKi,ΔKd，利用公式
更新Kp,Ki,Kd参数，式中K'p,K'i,K'd为上一个控制节拍下的控制参数，具体结构如图4所示，转步骤(4)；
(4)将偏差e和新的控制参数带入PID控制器，解算出所需的推进器电机电压值输出给电机，返回步骤(1)；
本发明将e，ΔKp，ΔKi，ΔKd的模糊论域均定义为{-6,-5,-4,-3,-2,-1,0,1,2,3,4,5,6}，为了确保模糊控制器的精度要求，将控制器输入、输出都划分为七档{NB，NM，NS，ZO，PS，PM，PB}，分别表示负大、负中、负小、零、正小、正中、正大，模糊隶属度函数选择应用较为普遍的三角型隶属度函数，采用面积中心平均法作为解模糊化的方法。
(a)远端模式模糊规则的确定
根据以上的参数整定原则，采用MAMDANI推理模型，同时结合输入/输出变量以及隶属度曲线的确定，分析人的实际丰富操纵经验可以产生如下一系列的航向、航速控制规则语言：
If e is NB andis NB,then u is PB
......
If e is PB andis PB,then u is NB
得到调整Kp，Ki，Kd三个参数的修正量ΔKp，ΔKi，ΔKd的模糊规制表如下：
表1远端模式ΔKp的控制规则表
表2远端模式ΔKi的控制规则表
表3远端模式ΔKd的控制规则表
(b)近岸模式规则表的确定
在控制系统中，响应速度慢是影响系统性能的一个主要因素，但是对于无人艇靠泊过程中对码头末端速度和航向的控制，快速响应相对于超调来说就没那么重要。
因此从限制超调现象出现出发，尽可能的使无人艇航向、航速快速响应，得到调整Kp，Ki，Kd三个参数的修正量ΔKp，ΔKi，ΔKd的模糊规制表如表4、表5、表6所示。
表4码头末端ΔKp的模糊规制表
表5码头末端ΔKi的模糊规制表
表6码头末端ΔKd的模糊规制表
以上所述仅为本发明的优选实施例而已，并不用于限制本发明，对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。