[发明专利]一种动力定位船舶的变旋转中心运动控制仿真方法

摘要

本发明提供一种动力定位船舶的变旋转中心运动控制仿真方法，通过旋转中心点在船体坐标系下的位置，计算船舶旋转中心速度和船舶中心速度的切换矩阵，计算旋转中心点的运动状态，计算期望运动状态，计算每个推进器的相对位置坐标，计算新的推进器位置布置矩阵，计算每个推进器的期望推力、期望回转方位角，将推进器实际输出的推力合成到旋转中心处，形成合力，计算在旋转中心点处的运动状态，计算在北东坐标系下的位置和姿态，计算旋转中心的位置。本发明能够有效的对动力定位船舶变旋转中心后的定点定位和路径跟踪等任务进行仿真，降低了仿真误差，能真实的反映实际情况，并能为实际的动力定位系统的变旋转中心运动控制提供技术支持。

主权项

1.一种动力定位船舶的变旋转中心运动控制仿真方法，其特征在于，具体的实现步骤为：/n步骤1.根据任务需求和相应的操作模式在旋转中心设置模块中设置船舶的旋转中心点，将旋转中心点在船体坐标系下的位置(x_c,y_c)传给变旋转中心的三自由度运动数学模块、推力分配模块、运动状态转换模块；/n步骤2.由设置的旋转中心，计算船舶旋转中心速度和船舶中心速度的切换矩阵；根据船体中心点的运动状态，计算出旋转中心点的运动状态；/n步骤3.将旋转中心点的运动状态输入到三自由度运动控制器模块，该模块根据设定的操作模式，选择对应的控制器，根据运动状态的位置偏差、艏向偏差和三自由度速度偏差计算出期望纵向推力、横向推力和转艏力矩；/n步骤4.将控制器产生的期望合力指令输入到变旋转中心的推力分配模块，计算每个推进器的相对位置坐标，计算新的推进器位置布置矩阵，最后根据推力分配优化模型采用序列二次规划算法或粒子群算法进行求解，得到每个推进器的期望推力和期望回转方位角；/n步骤5.将每个推进器的期望推力和期望回转方位角输入到推进器响应模块，输出期望推力到变旋转中心的推力合成模块；推力合成模块将每个推进器实际输出的推力合成到旋转中心处，形成合力τ_c；/n步骤6.将合力τ_c输入到变旋转中心的三自由度船舶运动数学模型中，计算船舶在旋转中心点处的加速度和船舶旋转中心处的三自由度速度υ_c；/n步骤7.将旋转中心处的速度υ_c输入到旋转中心和船体中心运动状态转换模块，计算船中心点的运动状态向量υ；计算船舶在北东坐标系下的位置和姿态向量η；计算船舶旋转中心点在北东坐标系下的位置及姿态向量η_c；此时完成仿真系统的一个工作循环；/n步骤8.循环执行步骤3到步骤7，若在仿真过程中多次切换了旋转中心坐标，则每次切换后的从步骤1开始，然后重复执行步骤3至步骤7。/n