一种桥门式起重机开环防摇方法与流程

本发明本属于应用在桥门式起重设备行走机构上的控制方法，防止悬挂货物摇摆的控制方法。

背景技术：

在某些桥门式起重设备上，例如轨道式龙门吊、轮胎式龙门吊、桥梁式起重机，行走机构会在钢丝绳悬挂货物的情况下做水平方向的运行，如控制不当，悬挂的货物会形成摇摆。这种摇摆会对机械及周边的环境造成损害，也会降低工作效率。控制这种摇摆通常有人工防摇、机械防摇和电子防摇三类方法，人工防摇对操作人员的熟练程度要求较高，且需要操作人员距离设备较近操作，在远程控制的应用中，当图像信号以通信的方式传送且有时间上的延迟时，人工防摇无法进行；机械防摇是从起重机的设计角度出发，让货物不会摇摆起来，如振华重工的八绳防摇，其缺点是设备的复杂程度增加，维护成本加大；电子防摇能够应用于远程操作，其方法很多，现有方法中西门子公司的方法需要安装复杂的图像传感器来采集摇摆的角度并进行摇摆的控制，容易受环境条件影响且成本较高；abb公司的方法无需传感器，只需检测单摆的绳长，可允许操作人员在任何时刻改变速度命令的大小和方向，但是由于其需要精确的等效绳长参与控制，在等效绳长检测误差存在时，残余摆动较大；安川公司的方法无需传感器，且能防止初始的摇摆，但是由于其原理是用摇摆的货物在行走机构上产生的负载转矩来近似等效摇摆的角度，在负载较轻时效果较差。

技术实现要素：
：

本发明要针对上述背景技术存在的问题，提供一种防摇控制效果更好的桥门式起重机开环防摇方法。

为解决上述技术问题，本发明的技术方案为

一种桥门式起重机开环防摇方法，行走机构通过挂绳悬挂货物，行走机构由电机驱动行驶，通过电机编码器检测单摆的绳长l，依据单摆绳长l获取单摆的摇摆周期t；获取人工输入的实时速度命令nref；实时速度命令nref经过速度命令斜坡发生器1生成第一速度命令ncmd1；延时单元2依据摇摆周期t对第一速度命令ncmd1进行延时，生成第二速度命令ncmd2；第一速度命令ncmd1与第二速度命令ncmd2经过求和计算器相加，再经过平均单元3生成第三速度命令ncmd3；依据第三速度命令ncmd3和电机实时速度nfk生成电机速度环控制的输入信号，驱动电机行驶。

较佳地，依据单摆绳长l获取单摆的摇摆周期t的方法为摇摆周期

较佳地，依据摇摆周期t对实时速度斜坡指令进行延时是指：将第一速度命令ncmd1延时t/2。

较佳地，依据第三速度命令ncmd3和电机实时速度nfk生成电机速度环控制的输入信号的方法包括：依据第三速度命令ncmd3生成第四速度命令ncmd，第四速度命令ncmd与电机实时速度nfk的差值经过速度pi调节器之后生成的转矩给定信号tgvn为电机速度环控制的输入信号。

较佳地，依据第三速度命令ncmd3生成第四速度命令ncmd的方法包括：获取电机实时速度nfk，实时速度nfk依次经过摇摆角度估计器10和防摇控制系数乘法器9之后生成防摇速度命令ncmd_θ，第三速度命令ncmd3和防摇速度命令ncmd_θ输入第一差值计算器生成第四速度命令ncmd。

较佳地，通过摇摆角度估计器10计算出摇摆角度的估计值θest

其中，ωn为单摆的自然频率，ωn＝1/t。

较佳地，防摇控制系数乘法器9将摇摆角度的估计值θest的值乘以防摇控制系数k得到防摇速度命令ncmd_θ。

较佳地，还包括防摇启动选择器，防摇启动选择器的两个输入端分别接收常数0输入信号和防摇速度命令ncmd_θ输入信号，防摇启动选择器将常数0或防摇速度命令ncmd_θ输出，防摇启动选择器的输出信号和第三速度命令ncmd3输入第一差值计算器生成第四速度命令ncmd。

较佳地，依据第三速度命令ncmd3生成第四速度命令ncmd的方法包括：将第三速度命令ncmd3输入带通滤波器生成第四速度命令ncmd；

带通滤波器的计算公式包括其中ωn为单摆的自然频率，为带通滤波器的带通比。

较佳地，第三速度命令ncmd3经过低通滤波器4之后生成低通滤波速度命令ncmd_lpf，依据低通滤波速度命令ncmd_lpf和电机实时速度nfk生成电机速度环控制的输入信号。

本发明的有益效果在于：本发明允许操作人员在任何时候改变行走机构的速度命令的大小和方向，当行走机构转速稳定或者停止之后，行走机构下悬货物没有残余摆动或残余摆动较小。本发明允许在等效绳长计算出现较大偏差时，保证行走机构下悬货物的残余摆动较小。本发明的能够在防摇功能未开启时实现摆角跟踪，当防摇功能开启时，将行走机构下悬货物的摆动消除。本发明鲁棒性强、无需图像传感器，只需要检测单摆的绳长，且能够在等效绳长检测误差存在的情况下保证货物的残余摆动较小，无论负载的大小，控制效果都较好。

附图说明

图1为本发明控制对象的原理图一；

图2为本发明控制对象的原理图二；

图3为本发明实施例一的控制原理图；

图4为在操作人员进行点动指令时未作任何防摇处理和在绳长检测准确的情况下仅采用摆角计算反馈进行防摇效果的仿真对比图；

图5为在操作人员进行点动指令时在绳长检测比实际等效绳长多2米时的情况下仅采用摆角计算反馈进行防摇和采用本发明第一个实施例进行防摇效果的仿真对比图；

图6为在操作人员进行点动指令时在绳长检测比实际等效绳长少2米时的情况下仅采用摆角计算反馈进行防摇和采用本发明第一个实施例进行防摇效果的仿真对比图；

图7为采用本发明实施例一开启低通滤波器和未开启滤波器时防摇效果及行走机构输出转矩的仿真对比图；

图8为采用本发明实施例一，在操作人员进行点动指令时不开启防摇，在点动指令结束后开启防摇的仿真波形图；

图9为本发明实施例二的控制原理图。

图中：1.速度命令斜坡发生器，2.延时单元，3.平均单元，4.低通滤波器，5.速度pi调节器，6.电机，7.防摇启动选择器，8.常数0单元，9.防摇控制系数乘法器，10.摇摆角度估计器，11.带通滤波器。

具体实施方式

由图1所示，行走机构的运行速度为v，水平运行导致的下悬货物摆动角度为θ。仅考虑行走机构下悬货物在行走平面的摆动，有的行走机构下悬货物的型式可等效为一个起升机构钢丝绳卷筒缠绕一根钢丝绳下悬货物，下悬货物的高度为l_1，当钢丝绳的卷筒转动时，货物的高度发生改变，如图1所示。

有的行走机构下悬货物的型式可等效为一个起升机构的两个钢丝绳卷筒各缠绕一根钢丝绳接在下悬货物上，当钢丝绳卷筒转动时，货物的高度发生改变，如图2所示。

通常等效摆长l_eff是用钢丝绳的长度l来近似的，在图1中这种近似带来的误差为l_1/2，在图2中假设货物的高度可忽略，这种近似带来的误差为l(1-cosα)。

本发明所采用的技术方案为：利用起升电机6编码器检测单摆的绳长，计算出单摆的摇摆周期t，对于操作人员的实时速度斜坡指令，延时t/2生成第二个速度斜坡指令，将实时速度斜坡指令与第二个速度斜坡指令的实时平均值作为第三个速度斜坡指令，第三个速度斜坡指令减去行走机构实际运行速度通过单摆数学模型得到的角度乘以一个系数的值作为行走机构电机6速度环控制的输入；第二种方法是第三个速度斜坡指令经过带通频率为单摆自然频率的带通滤波器11后作为行走机构电机6速度环控制的输入。

下面结合附图和实施例对本发明做进一步的说明。

实施例一

一种桥门式起重机开环防摇方法，行走机构通过挂绳悬挂货物，行走机构由电机6驱动行驶，通过电机6编码器检测单摆的绳长l，依据单摆绳长l获取单摆的摇摆周期t；获取人工输入的实时速度命令nref；实时速度命令nref经过速度命令斜坡发生器1生成第一速度命令ncmd1；延时单元2依据摇摆周期t对第一速度命令ncmd1进行延时，生成第二速度命令ncmd2；第一速度命令ncmd1与第二速度命令ncmd2经过求和计算器相加，再经过平均单元3生成第三速度命令ncmd3；依据第三速度命令ncmd3和电机6实时速度nfk生成电机6速度环控制的输入信号，驱动电机6行驶。

作为本实施例的一个优化方案还可以设置一个低通滤波器4，第三速度命令ncmd3经过低通滤波器4之后生成低通滤波速度命令ncmd_lpf，依据低通滤波速度命令ncmd_lpf和电机6实时速度nfk生成电机6速度环控制的输入信号。

依据单摆绳长l获取单摆的摇摆周期t的方法为摇摆周期依据摇摆周期t对实时速度斜坡指令进行延时是指将第一速度命令ncmd1延时t/2。

本实施例中依据第三速度命令ncmd3和电机6实时速度nfk生成电机6速度环控制的输入信号的方法为：依据第三速度命令ncmd3生成第四速度命令ncmd，第四速度命令ncmd与电机6实时速度nfk的差值经过速度pi调节器5之后生成的转矩给定信号tgvn为电机6速度环控制的输入信号。

依据第三速度命令ncmd3生成第四速度命令ncmd的方法为：获取电机6实时速度nfk，实时速度nfk依次经过摇摆角度估计器10和防摇控制系数乘法器9之后生成防摇速度命令ncmd_θ，第三速度命令ncmd3和防摇速度命令ncmd_θ输入第一差值计算器生成第四速度命令ncmd。

通过摇摆角度估计器10计算出摇摆角度的估计值θest的方法为：其中，ωn为单摆的自然频率，ωn＝1/t。

防摇控制系数乘法器9将摇摆角度的估计值θest的值乘以防摇控制系数k得到防摇速度命令ncmd_θ。

作为本实施例的一种改进方案，本方法还包括一个防摇启动选择器7，防摇启动选择器7的两个输入端分别接收常数0输入信号和防摇速度命令ncmd_θ输入信号，防摇启动选择器7将常数0或防摇速度命令ncmd_θ输出，防摇启动选择器7的输出信号和第三速度命令ncmd3输入第一差值计算器生成第四速度命令ncmd。

如图3所示，来自操作人员的速度命令nref经过带限幅的速度命令斜坡发生器1生成第一速度命令ncmd1，该速度命令经过延时单元2生成第二速度命令ncmd2，第一速度命令ncmd1与第二速度命令ncmd2相加后经过平均单元3生成第三速度命令ncmd3，该速度命令经过低通滤波器4生成滤波后的速度命令ncmd_lpf,该速度命令与由sw_antisway控制的防摇启动选择器7输出值相减生成第四速度命令ncmd，该速度命令与电机6的实际速度nfk相减得到的差值经过速度pi调节器5后产生转矩给定信号tgvn并驱动电机6。电机6的实际速度nfk经过摇摆角度估计器10生成摇摆角度的估计值θest,该角度估计值与防摇控制系数乘法器9相乘后进入防摇启动选择器7，防摇启动选择器7的另一个输入为常数0单元8。

这其中，延时单元2的作用是将第一速度命令ncmd1延时t/2,t为单摆的摇摆周期，其计算公式为：

该延时单元2的作用为增强在等效摆长检测误差大时的防摇效果的鲁棒性，即等效摆长检测出现误差时，也能保证货物的残余摆动较小。

摇摆角度估计器10为单摆角度的数学模型，其计算公式为：

其中ωn为单摆的自然频率，其计算公式为：

ωn＝1/t(3)

摇摆角度估计器10的作用就是通过数学模型来计算出货物所形成单摆的摇摆角度，从速度指令中减去前述摇摆角度乘以一个消摆系数就形成了对摇摆角度的抑制作用，摇摆角度越大，抑制作用越强，摇摆角度减小，抑制作用则减小，直到将摇摆抑制为0。

如图4所示，该图为操作人员进行点动指令时未作任何防摇处理和在绳长检测准确的情况下仅采用摆角计算反馈进行防摇效果的仿真对比图。绳长为10米，操作人员在0.5s给出速度命令并且在5s时停止速度指令。第一行的两个波形实线表示的是仅经过斜坡限幅的速度指令，破折线表示的是未做延时和平均处理，但在速度斜坡指令上减去摇摆角度估计值乘以一个防摇控制系数后得到的速度指令，其计算摇摆角度用到的绳长为10米，即与实际绳长一致；第二行的两个波形实线表示的是未做防摇处理的速度波形导致的货物摇摆角度，破折线表示的是前述做了防摇处理的速度指令导致的货物摇摆角度，可以看出，未做防摇处理时，在该点动指令下，货物摇摆的角度最大为6°，在计算绳长与实际绳长一致的情况下，做了前述的防摇处理时货物摇摆的角度最大为2°，且最后衰减为0°，摇摆被消除。

如图5所示，该图为操作人员进行点动指令时，在实际绳长比检测绳长多2米的情况下仅采用摆角计算反馈进行防摇和采用本发明进行防摇效果的仿真对比图。绳长为10米，操作人员在0.5s给出速度命令并且在5s时停止速度指令。从图中第二行实线表示的波形可以看出，仅采用摆角计算反馈进行防摇时，货物摇摆最大角度为2°，但是由于检测绳长出现误差，最终稳定的货物摇摆角度仍有1°。如果将仅采用摆角计算反馈进行防摇的速度指令延时单摆的摇摆周期一半发出时，会得到第二行的破折线表示的波形，货物摇摆最大角度为2°，最终稳定的货物摇摆角度仍有1°，不过比较实线和破折线波形可以看出，两者摇摆的最大角度虽然相同，但是相位却几乎相反。因此采用本发明进行防摇时，将速度指令延时单摆的摇摆周期一半，将延时前后的速度指令相加平均后得到的货物最终摇摆角度约为0.2°，用点线表示，比不采用本发明的方法减少了80％残余摆动。另外，从图4和图5的第三行可以看出，无论进行何种防摇处理，行走机构行走的距离都是一样的。

图6为操作人员进行点动指令时在实际绳长比检测绳长少2米的情况下仅采用摆角计算反馈进行防摇和采用本发明进行防摇效果的仿真对比图，从该图中可以得出与图5的分析基本一致的结论。

如图7所示，该图为采用本发明第一实施例时开启低通滤波器4和未开启滤波器时防摇效果及行走机构加速度的仿真对比图，从该图的第一行至第三行可以看出，开启低通滤波器4的防摇效果及行走机构的行走距离与未开启低通滤波器4时基本一致，但是从第四行可以看出，未开启低通滤波器4时，行走机构输出加速度(实线表示)的变化较为剧烈，而开启低通滤波器4后，行走机构输出加速度(破折线表示)平滑了许多，这对于行走机构的转矩冲击较小，有利于行走机构机械部分的维护减少。

如图8所示，该图为采用本发明第一实施例时，在操作人员进行点动指令时不开启防摇，在点动指令结束后开启防摇的仿真波形图。从0.5s-5s期间，未开启防摇，操作人员给出一个点动指令，可以看出摇摆的角度最大为3°，且不会衰减，但是摇摆的角度被实时计算出来。在10s时刻，防摇功能开启，可以从图8中第一行看出，立即有一个消除摆动的速度给定产生，从图8中第二行看出，经过5s之后，摇摆得以消除。

实施例二

本实施例与实施例一的区别在于依据第三速度命令ncmd3生成第四速度命令ncmd的方法，其他部分与实施例一相同。

本依据第三速度命令ncmd3生成第四速度命令ncmd的方法为：将第三速度命令ncmd3输入带通滤波器11生成第四速度命令ncmd；带通滤波器11的计算公式包括其中ωn为单摆的自然频率，为带通滤波器11的带通比。

由图9所示，来自操作人员的速度命令nref经过带限幅的速度命令斜坡发生器1生成第一速度命令ncmd1，该速度命令经过延时单元2生成第二速度命令ncmd2，第一速度命令ncmd1与第二速度命令ncmd2相加后经过平均单元3生成第三速度命令ncmd3，该速度命令经过低通滤波器4生成滤波后的速度命令ncmd_lpf,该速度命令经过带通滤波器11生成第四速度命令ncmd，该速度命令与电机6的实际速度nfk相减得到的差值经过速度pi调节器5后产生转矩给定信号tgvn并驱动电机6。

应当理解的是，对本领域普通技术人员来说，可以根据上述说明加以改进或变换，而所有这些改进和变换都应属于本发明所附权利要求的保护范围。