[发明专利]一种塔式起重机振幅饱和非线性输出反馈控制方法及系统

说明书

本发明公开了一种塔式起重机振幅饱和非线性输出反馈控制方法及系统，包括：基于拉格朗日方法及实际塔式起重机工作状态，构建塔式起重机动态模型；根据塔式起重机动态模型的期望位置与实际反馈数据的数据差作为误差信号，并根据误差信号设计变绳长PD控制器；将设计的变绳长PD控制器与基于系统可驱动信息构造的伪速度信号合并得到无速度测量变绳长PD控制器；无速度测量变绳长PD控制器基于饱和函数有界原则，构成无速度测量的五自由度塔式起重机振幅饱和非线性输出反馈控制器，对塔式起重机进行控制。本发明仅通过系统可驱动信息构造伪速度信号，能够有效获取实际工况中的系统速度信息，并对控制器的输出力矩进行限幅，提高了控制器的效率以及性能。

技术领域

本发明涉及塔式吊车防摇运动控制的技术领域，尤其涉及一种塔式起重机振幅饱和非线性输出反馈控制方法及系统。

背景技术

起重机在我们的日常生活中发挥着越来越重要的作用，也被用于越来越多的场合，由于起重机的工作场所比较复杂，在使用复杂的测量装置时，会存在速度信号难以测量的问题。而在实际工况中，电机输出也存在一定的限幅，所以如何有效的解决速度信号难以获得和保护电机不受较大输出影响的问题，是提高起重机运输效率首要考虑问题之一。因此通过利用塔式起重机动态模型，根据伪速度信号和限幅函数达到对塔式起重机良好的控制效果。

发明内容

本部分的目的在于概述本发明的实施例的一些方面以及简要介绍一些较佳实施例。在本部分以及本申请的说明书摘要和发明名称中可能会做些简化或省略以避免使本部分、说明书摘要和发明名称的目的模糊，而这种简化或省略不能用于限制本发明的范围。

鉴于上述现有存在的问题，提出了本发明。

因此，本发明提供了一种塔式起重机振幅饱和非线性输出反馈控制方法及系统解决现有的起重机控制方法没有考虑速度信号难以测量和电机输出限幅的问题。

为解决上述技术问题，本发明提供如下技术方案：

第一方面，本发明实施例提供了一种塔式起重机振幅饱和非线性输出反馈控制方法，包括：

基于拉格朗日方法及实际塔式起重机工作状态，构建塔式起重机动态模型；

根据所述塔式起重机动态模型的期望位置与实际反馈数据的数据差作为误差信号，并根据所述误差信号设计变绳长PD控制器；

将所述设计的变绳长PD控制器与基于系统可驱动信息构造的伪速度信号合并得到无速度测量变绳长PD控制器；

所述无速度测量变绳长PD控制器基于饱和函数有界原则，构成无速度测量的五自由度塔式起重机振幅饱和非线性输出反馈控制器，对塔式起重机进行控制。

作为本发明所述的塔式起重机振幅饱和非线性输出反馈控制方法的一种优选方案，其中：所述塔式起重机动态模型表示为：

其中，M为小车的质量，m为负载的质量，l为小车与负载之间的绳长，x为小车定位，α为悬臂旋转角度，θ₁和θ₂分别为投射到与吊臂平行的垂直平面上的角度和投射到垂直于悬臂的垂直平面上的角度，J₀为旋转方向转动惯量，T_a为悬臂方向的驱动力，F_x为小车方向的驱动力，F_l为绳子方向的驱动力。

作为本发明所述的塔式起重机振幅饱和非线性输出反馈控制方法的一种优选方案，其中：所述塔式起重机动态模型的期望位置与实际反馈数据的数据差作为误差信号，包括：小车位置误差，悬臂角度误差，绳子长度误差，投射到与吊臂平行的垂直平面上的角度误差以及投射到垂直于悬臂的垂直平面上的角度误差；

误差信号的向量形式表示为：