一种船舶航向区间控制方法和系统技术方案

本发明专利技术公开了一种舵角舵速约束下的水面船舶航向区间控制方法和系统，属于船舶运动控制领域。本发明专利技术的方法包括：计算多步预测状态矩阵；计算多步输入矩阵；更新反馈校正矩阵并计算多步预测航向；根据当前方向舵角度计算舵角舵速约束下的舵角增量输出向量；取舵角增量输出向量的第一行作为当前时刻舵角增量输出。本发明专利技术适用于舵角舵速约束下的水面船舶航向区间控制，有利于减少船舶舵机机械结构的磨损，减少船舶航行过程中的能耗。

【技术实现步骤摘要】
一种船舶航向区间控制方法和系统
本专利技术属于船舶运动控制领域，更具体地，涉及一种船舶航向区间控制方法和系统。
技术介绍
船舶航向控制对于现代船舶航行具有非常重要的意义，现代船舶的航向控制功能通常通过自动舵或具有类似功能的航向控制器实现。通过预设路径点和导航算法，船舶可以自动地航行至目的地港口，大大提高船舶航行的稳定性，减轻船员的工作负担。导航算法给出的参考航向多是一个固定航向，现有技术也多是针对航向定值控制这一问题，船舶在海洋中航行的过程中易受到风浪流等外界干扰，如果说采用航向定值控制，将航向保持在一个固定值，则需要在航行过程中针对外界干扰频繁打舵修正航向。船舶本身具有较大的质量，因此拥有很大的惯性，依靠打舵修正航向只能解决由外界干扰中低频部分造成的航向偏移，而针对外界干扰中的高频部分进行打舵修正效果有限且会加速舵机的磨损，增加船舶的功耗。不同于定值控制，区间控制的目的是将被控对象控制在一个给定的区间内而不是控制在一个给定的值。对于航行在海洋中的船舶来说，若将船舶的航向控制在一个给定的区间内，就能够一定程度上忽视外界干扰中的高本文档来自技高网...

【技术保护点】
1.一种船舶航向区间控制方法，其特征在于，包括以下步骤：/n根据航向控制增广状态空间方程中的状态预测矩阵A计算多步预测状态矩阵P，根据输入矩阵B计算多步输入矩阵H；/n根据当前k时刻的航向角

【技术特征摘要】
1.一种船舶航向区间控制方法，其特征在于，包括以下步骤：
根据航向控制增广状态空间方程中的状态预测矩阵A计算多步预测状态矩阵P，根据输入矩阵B计算多步输入矩阵H；
根据当前k时刻的航向角和舵角通过观测器获取当前k时刻状态变量估计值zk，并更新反馈校正矩阵D；
由所述当前k时刻状态变量估计值zk，通过所述多步预测状态矩阵P、多步输入矩阵H和更新之后的反馈校正矩阵D获取多步预测状态变量
构建包含优化参考轨迹α、舵角增量输出向量Δδr和所述多步预测状态变量的代价函数，结合舵角约束条件、舵速约束条件和区间约束条件，求解约束条件下的二次规划，从而获得舵角舵速约束下的舵角增量输出向量Δδr。


2.如权利要求1所述的船舶航向区间控制方法，其特征在于，所述船舶航向控制增广状态空间方程为



其中







是当前k时刻舵角增量输出向量，a11，a12，a21，a22是已知的水动力相关参数，b1，b2是已知的执行器相关参数，vk是船舶的横向速度，rk是船舶的艏向角速度，是航向角，是舵角。


3.如权利要求2所述的船舶航向区间控制方法，其特征在于，所述多步预测状态矩阵



所述多步输入矩阵



其中ny是预测步长，C为一个常值矩阵且C＝[0010]，所述多步输入矩阵H的列数为控制步长nu。


4.如权利要求3所述的船舶航向区间控制方法，其特征在于，所述更新反馈校正矩阵D包括：
1)在当前k时刻计算航向预测值
2)获取实际值与所述航向预测值的误差
3)根据所述误差获取航向校正隹其中λ为小于1的常数，的初始值
4)由所述航向校正值更新反馈校正矩阵


5.如权利要求4所述的船舶航向区间控制方法...

【专利技术属性】
技术研发人员：赵金，王旭东，耿涛，
申请(专利权)人：华中科技大学，
类型：发明
国别省市：湖北;42