1.一种永磁直驱起重机钢丝绳防摇摆系统,其特征是:包含姿态估计模块(1)、PID控制器(3)、中央处理器(2)和安全保护模块(4);
所述姿态估计模块(1)包含多个传感器(101)和算法估计芯片(102),其中多个传感器(101)分别用于检测钢丝绳摆动的角度和速度,以及起重机的运行速度和运行方向,算法估计芯片(102)则能够根据多个传感器(101)的检测结果计算出钢丝绳摇摆的数学模型;
所述算法估计芯片(102)计算数学模型的算法采用卡尔曼滤波;
卡尔曼滤波的计算方法如下:
1)建立钢丝绳摆动的动态模型,并根据动态模型建立状态方程和观测方程,其中状态方程描述了钢丝绳摇摆状态如何从一个时刻演变到下一个时刻,观测方程则描述了如何根据当前时刻的测量值获取系统的部分状态信息;
2)初始化滤波器,给定初始状态的估计值和协方差矩阵作为滤波器的初始状态;
3)预测步骤:根据系统的状态方程,使用上一时刻的状态估计值来预测当前时刻的状态估计值,并计算预测值的协方差矩阵;
4)更新步骤:利用当前时刻的测量值和观测方程,根据预测的状态估计值来更新状态估计值,并计算更新后的协方差矩阵;
5)重复进行预测和更新步骤,即时更新系统的状态估计值和协方差矩阵;
所述中央处理器(2)能够根据数学模型判断出钢丝绳的当前摇摆状态和预测摇摆状态;
所述钢丝绳摆动的动态模型分为:
①钢丝绳动力学方程:
;
其中, 为钢丝绳上受到的拉力、 为钢丝绳的质量(假设均匀分布)、 为钢丝绳的长度、 为钢丝绳的角加速度;
②负载动力学方程:
;
其中, 为负载受到的合力、 为负载的质量、 为负载的长度、 为负载与水平方向的夹角、g表示重力加速度;
而假设负载被视为质点,根据牛顿第二定律,可以得到负载的角加速度 满足:;
③状态空间表示:
假设状态向量 x = T,其中 和 分别表示钢丝绳和负载的角加速度;
根据上述方程,可以写出状态方程和观测方程:其中状态方程为:
;
其中,k 表示时间步,x(k) 是系统在时刻 k 的状态向量,A(k‑1) 是状态转移矩阵, B(k‑1) 是输入矩阵,u(k‑1) 是系统在时刻 k‑1 的输入向量,w(k‑1) 是过程噪声;
而观测方程为:
;
其中y(k) 是通过传感器或测量设备观测到的系统状态向量,C(k) 是观测矩阵,v(k) 是观测噪声;
所述PID控制器(3)能够根据钢丝绳的当前摇摆状态和预测摇摆状态计算出对应的控制信号,并将控制信号传输至中央处理器(2),由中央处理器(2)控制起重机执行相应动作来抵消钢丝绳的摇摆;
所述安全保护模块(4)能够在钢丝绳摆动角度超过预设值时,对起重机进行紧急制动;
所述安全保护模块(4)包含安全芯片(401)、震动传感器(402)和风速传感器(403),其中安全芯片(401)由独立的外部电源供电,且安全芯片(401)与中央处理器(2)电连接,所述安全芯片(401)内设有钢丝绳倾角的限位值、起重机速度的限位值、起重机震动频率的限位值,以及风速的限位值;所述震动传感器(402)用于检测起重机整体的震动频率,风速传感器(403)用于检测钢丝绳受到的风速,且震动传感器(402)和风速传感器(403)均与中央处理器(2)电连接。