一种基于模型预测控制的松弛动力定位控制系统

摘要

本发明公开了一种基于模型预测控制的松弛动力定位控制系统，包括：传感器模块、扩展卡尔曼滤波器、海图计算单元、环境干扰补偿器、控制器、船舶动力装置。传感器模块包括位置参考系统和罗经，将北东坐标信息x、y和航向信息ψ传给扩展卡尔曼滤波器；扩展卡尔曼滤波器估计出系统的状态估计信息，海图计算单元将产生状态期望信息，环境干扰补偿器得到环境干扰力传送给控制器，控制器包括优化器和非线性模型预测控制器，优化器产生最优初始控制值传送给非线性模型预测器，非线性模型预测器产生控制指令传送给船舶动力装置。本发明产生的控制信号是缓慢变化的，从能量角度来看是最优的，有效的减少能耗和推进装置的磨损。

主权项

一种基于模型预测控制的松弛动力定位控制系统，其特征在于：包括传感器模块、扩展卡尔曼滤波器、海图计算单元、环境干扰补偿器、控制器、船舶动力装置；传感器模块包括位置参考系统和罗经，位置参考系统采集船舶实际位置经纬度转化为北东坐标系信息x、y后传送给扩展卡尔曼滤波器，罗经采集航向信息ψ传送给扩展卡尔曼滤波器；扩展卡尔曼滤波器根据接收的北东坐标信息x、y和航向信息ψ估计出的状态估计信息，状态估计信息包括：北向坐标估计值东向坐标估计值航向角估计值纵向速度估计值横向速度估计值转首角速度估计值动力定位流流速估计值和动力定位流流向估计值将状态估计信息分别传送给海图计算单元、环境干扰补偿器和控制器；海图计算单元根据接收的北向坐标估计值东向坐标估计值航向角估计值和控制台人机界面输入的指令，产生动态的北向坐标期望值x_d、东向坐标期望值y_d、航向角期望值ψ_d，传送给控制器；环境干扰补偿器根据接收的状态估计信息，使用历史控制信息，得到环境干扰力以缓慢变化的形式传送给控制器；控制器包括优化器和非线性模型预测控制器，优化器产生最优初始控制值传送给非线性模型预测器，非线性模型预测器产生控制指令传送给船舶动力装置。