[发明专利]基于卡尔曼滤波的双缸液压闸门油缸行程误差补偿方法

摘要

本发明提供一种基于卡尔曼滤波的双缸液压闸门油缸行程误差补偿方法，应用在闸门调试运行过程中，利用仪器检测闸门在启闭运行过程中的左右油缸行程偏差值、闸门水封挤压值、闸门噪声值、闸门振动值等闸门运行状态的观测数据，并输入到卡尔曼滤波方程中，将更新后的预测值作为油缸行程修正值，作为实际的油缸行程值，闸门电气控制系统根据预测的油缸行程值，调节整定比例调节阀的电压值，使左右油缸运行速率发生变化，两缸行程差随之变化，进而调整闸门在门槽中的状态，以最佳轨迹运行，保证闸门高效稳定可靠。

主权项

1.一种基于卡尔曼滤波的双缸液压闸门油缸行程误差补偿方法，其特征在于包括如下步骤：(1)定义闸门状态X，X包括闸门左右开度偏差值，初始状态为0；(2)定义测量值Z，包括左右油缸行程偏差值C、闸门水封挤压值、闸门噪声值、闸门振动值；(3)定义状态转移矩阵A＝1，表示如何由上一状态推测当前状态，其为常值；(4)定义传感器的观测矩阵H＝[0.25 0.25 0.25 0.25]，表示由闸门的状态转换为观测值的转换矩阵，其为常值；(5)定义传感器的观测噪声协方差矩阵，设定为白噪声，正态分布，(6)定义闸门左右开度偏差状态协方差矩阵P，初始值为1；(7)定义表示外部干扰的状态转移协方差矩阵Q＝0.001；(8)根据卡尔曼滤波方程的状态预测方程来预测这一刻的闸门左右开度偏差状态，其中是上一刻闸门左右开度偏差状态，A是上述的闸门左右开度偏差状态转移矩阵，U_k‑1是控制输入，B是控制输入转移矩阵，这里没有控制，输入为0。所述预测方程表示基于上一刻的闸门左右开度偏差状态以及输入来预测这一刻的闸门左右开度偏差状态；(9)根据卡尔曼滤波方程的预测协方差方程来更新预测的协方差矩阵其中P_k‑1是上一刻的闸门左右开度偏差状态协方差矩阵，当k＝0时取步骤(6)所述的初始值，Q是步骤(7)所述的表示外部干扰的状态转移协方差矩阵；(10)根据卡尔曼滤波方程的增益更新方程来更新卡尔曼增益，其中由步骤9获得；(11)根据卡尔曼滤波方程的测量更新方程利用这一刻k时刻的测量值Z_k更新预测值，其中由步骤（8）获得，K_k由步骤(10)获得，所述的测量值包括上述的左右油缸行程偏差值、闸门水封挤压值、闸门噪声值、闸门振动值；(12)根据卡尔曼滤波方程的误差协方差更新方程更新误差协方差，其中I是单位矩阵，K_k由步骤10获得，由步骤(9)获得；计算由若干个计算周期组成，当闸门行程工作结束后停止计算，每个计算周期由步骤(8)到步骤(12)组成，依次执行，一直到闸门工作结束，通过步骤(11)可得到计算结果，即预测值用来作为闸门控制左右开度偏差的输入。