【技术实现步骤摘要】
本专利技术涉及舰船执行机构控制，尤其涉及基于融合优化算法的舰船执行机构运动控制方法。
技术介绍
1、舰船执行机构控制是船舶工程领域的一个重要研究方向，其目的是通过控制舰船的各种执行机构，如主推进器、舵、侧推器和减摇鳍等，实现对舰船运动的精确控制。随着现代舰船向大型化、智能化和多功能化发展，对执行机构控制的精度和可靠性要求越来越高。舰船在复杂海况下面临着各种外部干扰，如风、浪、流等，这给执行机构控制带来了巨大挑战。
2、在舰船执行机构控制领域，pid（比例-积分-微分）控制器是最常用的控制方法之一。pid控制器因其结构简单、鲁棒性好而被广泛应用于舰船控制系统中。它通过计算误差的比例项、积分项和微分项，并将这三项的加权和作为控制输出，从而实现对系统的控制。pid控制器的优点在于其易于实现和调节，对系统参数变化具有一定的适应能力。然而，在处理强非线性、大时滞和时变系统时，传统pid控制器的性能可能会受到限制。因此，如何优化pid控制器的参数以适应复杂的舰船动力学和海洋环境，成为研究的重点之一。
3、针对pid控制器的优化，研究人员提出了多种算法，如遗传算法、粒子群优化算法、蚁群算法等。这些算法通过模拟自然界的进化或群体行为，在解空间中搜索最优解，以实现pid控制器参数的自动调整。然而，现有的优化算法在处理高维复杂问题时仍存在一些不足。首先，单一的优化算法容易陷入局部最优，难以获得全局最优解。其次，大多数算法未充分考虑舰船动力学特性和环境因素的影响，导致优化结果在实际应用中可能不够理想。
<
1、有鉴于此，本专利技术提出了基于融合优化算法的舰船执行机构运动控制方法，旨在解决现有控制方法在复杂海况下适应性不足的问题。该方法通过融合多源传感器数据、应用自适应卡尔曼滤波算法进行状态估计，并采用两阶段融合优化算法对混合控制器参数进行优化。这种方法能够适应不同的控制模式，考虑环境因素影响，提高舰船在各种海况下的操控性能，实现更精确、可靠的执行机构控制。
2、本专利技术的技术方案是这样实现的：本专利技术提供了基于融合优化算法的舰船执行机构运动控制方法，包括：
3、s1 预设多种舰船控制模式，每种控制模式对应有特定的优化目标；
4、s2 利用多源传感器实时采集舰船运动状态和环境参数数据，对采集的多源传感器数据进行融合处理，并对舰船当前运动状态进行估计；
5、s3 根据估计的运动状态、当前任务需求和环境条件，选择舰船控制模式；
6、s4 利用融合优化算法，基于所选舰船控制模式的优化目标、估计的运动状态，动态优化混合控制器参数；
7、s5 基于优化后的参数，生成混合控制器的控制指令，将控制指令传递给相应的执行机构，执行机构按照控制指令运行。
8、在上述方案的基础上，优选的，舰船控制模式包括：
9、航向保持模式，其优化目标为最小化航向偏差；
10、航迹跟踪模式，其优化目标为最小化航迹偏差；
11、动态定位模式，其优化目标为在复杂海况下最小化位置和艏向偏差；
12、节能巡航模式，其优化目标为最小化燃料消耗；
13、避碰模式，其优化目标为最大化安全距离。
14、在上述方案的基础上，优选的，步骤s2包括：
15、s21 利用多源传感器实时采集原始数据，包括imu数据、gnss数据、磁罗盘数据、水流速度数据、气象数据和波浪数据；
16、s22 对采集到的原始数据进行预处理，包括去除异常值、统一时间戳和坐标系转换；
17、s23 利用卡尔曼滤波算法对预处理后的多源传感器数据进行融合，得到舰船的状态估计，包括位置、速度、姿态和角速度；
18、s24 对于水流速度数据、气象数据和波浪数据，使用时间序列分析方法进行短期预测，以补偿传感器延迟。
19、在上述方案的基础上，优选的，步骤s23包括：
20、定义舰船的状态向量 y如下：，
21、其中，，，分别为经度、纬度和高度，，，分别为北向速度、东向速度和垂向速度，为横滚角，为俯仰角，为偏航角，，，分别为横滚角速度、俯仰角速度和偏航角速度；
22、建立系统模型，包括：
23、，
24、，
25、其中，是状态向量，是观测向量，是状态转移矩阵，是观测矩阵，是控制输入，是控制输入矩阵，和分别是过程噪声和观测噪声；
26、对状态和协方差进行预测：
27、，
28、，
29、式中，为k时刻的先验状态估计，为k-1时刻的后验状态估计，为k时刻的先验误差协方差矩阵，为k-1时刻的后验误差协方差矩阵，为跟踪因子，为过程噪声协方差矩阵；
30、计算卡尔曼增益，并对状态和协方差进行更新：
31、，
32、，
33、，
34、式中，为卡尔曼增益，为测量噪声协方差矩阵，为实际观测值，为k时刻的后验状态估计，为单位矩阵；
35、自适应噪声协方差调整：
36、，
37、，
38、，
39、式中，为创新序列，为估计的实际测量噪声协方差，为滑动窗口大小，为遗忘因子；
40、跟踪滤波调整：
41、，
42、，
43、式中，为矩阵的迹运算，为跟踪因子的调整步长；
44、对于不同的传感器数据，相应调整观测矩阵；
45、输出状态估计：
46、，
47、式中，，，为估计的经度、纬度、高度，，，为估计的北向、东向、垂向速度，，，为估计的横滚角、俯仰角、偏航角，，，为估计的横滚角速度、俯仰角速度、偏航角速度。
48、在上述方案的基础上，优选的，对于不同的传感器数据，相应调整观测矩阵，包括：
49、对于imu数据，矩阵设置为只关联状态向量中的姿态，，和角速度，，量；
50、对于gnss数据，矩阵设置为只关联状态向量中的位置，，和速度，，分量；
51、对于磁罗盘数据，矩阵设置为只关联状态向量中的偏航角分量。
52、在上述方案的基础上，优选的，步骤s4包括：
53、s41 构建混合控制器，包括pid控制器、模糊控制器和神经网络控制器；
54、s42 定义优化目标函数j，根据所选的控制模式的优化目标和估计的运动状态设置权重系数；
55、s43 利用融合优化算法，对混合控制器的参数进行迭代优化，在优化时，一个解为一组混合控制器的参数，当迭代结束，则输出最优的一组混合控制器的参数；
56、s44 将优化得到的最优混合控制器的参数应用于混合控制器。
57、在上述方案的基础上，优选的，融合优化算法包括第一优化算法和第二优化算法，步骤s43包括本文档来自技高网...
【技术保护点】
1.基于融合优化算法的舰船执行机构运动控制方法，其特征在于，包括：
2.如权利要求1所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，舰船控制模式包括：
3.如权利要求2所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，步骤S2包括：
4.如权利要求3所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，步骤S23包括：
5.如权利要求4所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，对于不同的传感器数据，相应调整观测矩阵，包括：
6.如权利要求4所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，步骤S4包括：
7.如权利要求6所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，融合优化算法包括第一优化算法和第二优化算法，步骤S43包括：
8.如权利要求7所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，目标函数J的表达式如下：
9.如权利要求7所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，
10.如权利要求7所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，步骤S5包括：
...【技术特征摘要】
1.基于融合优化算法的舰船执行机构运动控制方法，其特征在于，包括：
2.如权利要求1所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，舰船控制模式包括：
3.如权利要求2所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，步骤s2包括：
4.如权利要求3所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，步骤s23包括：
5.如权利要求4所述的基于融合优化算法的舰船执行机构运动控制方法，其特征在于，对于不同的传感器数据，相应调整观测矩阵，包括：
6.如权利要求4所述的基于...
【专利技术属性】
技术研发人员：张洪峰，刘志宏，王浩，王红军，黄柳，
申请(专利权)人：中国船舶集团有限公司第七一九研究所，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。