CN113879860A - 基于动力学的斗轮堆取料机恒流量取料方法及装置 - Google Patents
基于动力学的斗轮堆取料机恒流量取料方法及装置 Download PDFInfo
- Publication number
- CN113879860A CN113879860A CN202111305107.3A CN202111305107A CN113879860A CN 113879860 A CN113879860 A CN 113879860A CN 202111305107 A CN202111305107 A CN 202111305107A CN 113879860 A CN113879860 A CN 113879860A
- Authority
- CN
- China
- Prior art keywords
- bucket
- slewing
- wheel
- wheel stacker
- target
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G65/00—Loading or unloading
- B65G65/005—Control arrangements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
- B65G43/08—Control devices operated by article or material being fed, conveyed or discharged
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G65/00—Loading or unloading
- B65G65/02—Loading or unloading machines comprising essentially a conveyor for moving the loads associated with a device for picking-up the loads
- B65G65/16—Loading or unloading machines comprising essentially a conveyor for moving the loads associated with a device for picking-up the loads with rotary pick-up conveyors
- B65G65/20—Paddle wheels
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G2203/00—Indexing code relating to control or detection of the articles or the load carriers during conveying
- B65G2203/02—Control or detection
- B65G2203/0266—Control or detection relating to the load carrier(s)
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Control Of Conveyors (AREA)
Abstract
本公开提供一种基于动力学的斗轮堆取料机恒流量取料方法及装置。包括:获取斗轮堆取料机的设备机械参数和基本运行数据;基于机器人动力学理论建立斗轮堆取料机的动力学模型,并建立一种基于动力学模型的PID算法;获取斗轮堆取料机的回转机构的实际驱动力矩,根据实际驱动力矩和动力学模型,通过PID算法得到斗轮堆取料机的回转机构所需调整的目标回转角速度和目标回转角加速度;控制斗轮堆取料机的回转机构以目标回转角速度和目标回转角加速度运行,以使得斗轮堆取料机实现恒流量取料。以堆取料机的动力学数学模型为基础,提出了驱动力矩或者驱动电机电流与角速度和角加速度之间的数学关系,更有利于实现恒流量控制的目的,提高控制精度。
Description
技术领域
本公开属于斗轮堆取料控制技术领域,具体涉及一种基于动力学的斗轮堆取料机恒流量取料方法及装置。
背景技术
斗轮堆取料机是火力发电厂燃料***常用设备。司机可通过司机室的操作杆来操控堆取料机的行走、悬臂俯仰和回转动作。手动操作时,司机通过观察悬臂皮带和斗轮电流大小或者根据操作经验观察的方法来判断取料流量的大小。随着智慧电厂、数字化煤场的推进,斗轮堆取料机作为燃料***的重要设备,改变传统人工堆取料作业方式,引入自动化手段,实现斗轮堆取料机堆料、取料作业全过程的自动化,提高燃料管理的自动化水平,已势在必行。
作为衡量堆取料机自动化水平的重要运行参数就是自动取料作业悬臂皮带煤流量的恒定性。传统自动取料悬臂皮带恒流量控制采用不同的角度区间给定不同的回转速度或者通过斗轮电机电流进行控制,当斗轮电流大降低回转速度、当斗轮电流小则增加回转速度。以上方法均未建立堆取料机的动力学数学模型即没有找到驱动力和回转角速度、回转角加速度之间的数学关系,并以数学模型为基础对受控对象进行控制,未能从根本上解决控制悬臂皮带恒流量的方法。
发明内容
本公开旨在至少解决现有技术中存在的技术问题之一,提供一种基于动力学的斗轮堆取料机恒流量取料方法及装置。
本公开的一方面,提供一种基于动力学的斗轮堆取料机恒流量取料方法,所述方法包括:
获取斗轮堆取料机的设备机械参数和基本运行数据;
根据所述设备机械参数和所述基本运行数据,基于机器人动力学理论建立所述斗轮堆取料机的动力学模型,并建立一种基于动力学模型的PID算法,所述动力学模型用于表征回转机构驱动力矩和回转、俯仰驱动机构角速度及角加速度之间的关系;
获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,根据所述实际驱动力矩和所述动力学模型,通过所述PID算法得到所述斗轮堆取料机的所述回转机构所需调整的目标回转角速度和目标回转角加速度;
控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行,以使得所述斗轮堆取料机实现恒流量取料。
在一些实施方式中,所述动力学模型满足下述关系式:
其中,S=sin,C=cos,m2为回转机构的质量,m3为悬臂机构的质量,m4为斗轮支撑机构的质量,m5为斗轮中心支架机构的质量,mw为斗轮机构的质量,l2为俯仰中心至回转中心的距离,l3为悬臂长度,l4为斗轮中心至回转中心的垂直距离,l5为斗轮中心至悬臂中心的水平距离,θ2为回转角度,为回转角速度,为回转角加速度,θ3为悬臂的俯仰角度,为俯仰角速度,为俯仰角加速度。
在一些实施方式中,所述获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,包括:
在所述回转机构上设置转矩测量传感器,根据所述转矩测量传感器得到所述回转机构的实际驱动力矩。
在一些实施方式中,所述获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,包括:
根据所述基本运行数据,计算得到驱动力矩和工作电流之间的关系式;
获取所述回转机构的实际工作电流,根据所述实际工作电流和所述关系式,得到所述回转机构的实际驱动力矩。
在一些实施方式中,所述工作电流采用加权电流,其满足下述关系式:
IW=IB+AIS
其中,IB为轮斗电机电流、IS为回转电机电流、A为加权系数;对加权电流IW采取分级控制模式,分别为设定值ISV、偏大值IH、过大值IHH、保护值IHHH;
所述控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行,包括:
当IW∈(0,IH)时,则根据计算出的所述目标回转角速度和目标回转角加速度进行恒流量回转取料作业,将输出值维持在设定值ISV附近;
当IW∈[IH,IHH)时,则停止回转动作;待加权电流IW∈(0,IH)时继续执行上述恒流量回转取料作业;
当IW∈(IHH,IHHH)时,则调整大车的行走位置,自动后退设定的距离,待加权电流IW∈(0,IH)时继续执行上述恒流量回转取料作业,并累加和记录自动后退距离以便至下一个回转取料周期中使用;
在取料过程中发生严重的坍塌时导致IW≥IHHH,则紧急停机,停止取料作业。
在一些实施方式中,在控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行之前,所述方法还包括:
获取目标料堆的料堆三维模型,并得到所述目标料堆的边界位置信息;
根据所述料堆三维模型,计算出分层层数和和每层取料切入点对应的斗轮堆取料机的定位数据,所述定位数据包括行走位置、回转角度和俯仰角度;
控制所述斗轮堆取料机移至所述目标料堆的顶层取料切入点,按照计算出的回转角度范围和俯仰高度进行回转取料作业;
当悬臂到达料堆边界时,斗轮堆取料机大车寸进设定的距离,然后反方向回转取料;
当上一层取料完毕,斗轮堆取料机自动移动到下一层取料切入点进行回转取料,直至达到预设的取料任务;
并且,在取料过程中控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行。
本公开的另一方面,提供一种基于动力学的斗轮堆取料机恒流量取料装置,所述装置包括:
获取模块,用于获取斗轮堆取料机的设备机械参数和基本运行数据;
建立模块,用于根据所述设备机械参数和所述基本运行数据,基于机器人动力学理论建立所述斗轮堆取料机的动力学模型,并建立一种基于动力学模型的PID算法;所述动力学模型用于表征回转机构驱动力矩和回转、俯仰驱动机构角速度及角加速度之间的关系;
计算模块,用于获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,根据所述实际驱动力矩和所述动力学模型,通过所述PID算法得到所述斗轮堆取料机的所述回转机构所需调整的目标回转角速度和目标回转角加速度;
控制模块,用于控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行,以使得所述斗轮堆取料机实现恒流量取料。
在一些实施方式中,所述动力学模型满足下述关系式:
其中,S=sin,C=cos,m2为回转机构的质量,m3为悬臂机构的质量,m4为斗轮支撑机构的质量,m5为斗轮中心支架机构的质量,mw为斗轮机构的质量,l2为俯仰中心至回转中心的距离,l3为悬臂长度,l4为斗轮中心至回转中心的垂直距离,l5为斗轮中心至悬臂中心的水平距离,θ2为回转角度,为回转角速度,为回转角加速度,θ3为悬臂的俯仰角度,为俯仰角速度,为俯仰角加速度。
本公开的另一方面,提供一种电子设备,包括:
一个或多个处理器;
存储单元,用于存储一个或多个程序,当所述一个或多个程序被所述一个或多个处理器执行时,能使得所述一个或多个处理器实现根据前文记载的所述的方法。
本公开的另一方面,提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时能实现根据前文记载的所述的方法。
本公开的基于动力学的斗轮堆取料机恒流量取料方法及装置,以堆取料机的动力学数学模型为基础,提出了驱动力矩或者驱动电机电流与角速度和角加速度之间的数学关系,更有利于实现恒流量控制的目的,提高控制精度。可以适应于全煤型料堆的自动取料作业,对于不规则或者凹凸不平的料堆也能够完成自动取料的目的。
附图说明
图1为本公开一实施例的斗轮堆取料机的三维简图;
图2为本公开另一实施例的基于动力学的斗轮堆取料机恒流量取料方法;
图3为本公开另一实施例的斗轮堆取料机位置矢量示意图;
图4为本公开另一实施例的恒流量控制框图;
图5为本公开另一实施例的基于动力学的斗轮堆取料机恒流量取料装置的结构示意图。
具体实施方式
为使本领域技术人员更好地理解本公开的技术方案,下面结合附图和具体实施方式对本公开作进一步详细描述。
本实施例的一方面,涉及一种基于动力学的斗轮堆取料机恒流量取料方法,如图1所示,斗轮堆取料机一般包括俯仰机构、回转机构和行走机构。
如图2所示,一种基于动力学的斗轮堆取料机恒流量取料方法,包括:
S011、获取斗轮堆取料机的设备机械参数和基本运行数据。
具体地,在本步骤中,所获取的设备机械参数和基本运行数据如下表1所示。
表1
S012、根据所述设备机械参数和所述基本运行数据,基于机器人动力学理论建立所述斗轮堆取料机的动力学模型,并建立一种基于动力学模型的PID算法,所述动力学模型用于表征回转机构驱动力矩和回转、俯仰驱动机构角速度及角加速度之间的关系。
具体地,一并参考图3,其中,θ1、θ2和θ3分别为行走机构的角度、回转角度和俯仰角度,r1至r5分别为斗轮堆取料机行走坐标系原点o1至各机构的位置矢量,按照机器人动力学的定义,并利用斗轮堆取料机各连杆位置矢量关系计算得到各驱动机构的动力学模型。
S013、获取目标料堆的料堆三维模型,并得到料堆的边界位置信息。
具体地,在本步骤中,可以通过三维激光扫描仪获取目标料堆的三维模型,三维处理软件将从激光扫描仪得到的点云信息处理成目标料堆的三维模型,并得到目标料堆的边界位置信息。三维模型为实现自动取料提供模型基础和数据基础。
自动取料开始之前,设定自动取料的任务信息,包括起始位置、终止位置、大车寸进距离、分层层数、取料流量等信息。根据任务信息和料堆三维模型数据计算出分层层数和和每层取料切入点对应的斗轮堆取料机的定位数据,包括行走位置、回转角度和俯仰角度。
S014、启动自动取料任务。
具体地,在本步骤中,PLC根据取料动作接收取料位置信息。PLC根据取料位置信息控制斗轮堆取料机移至目标料堆的顶层取料切入点,按照计算出的回转角度范围和俯仰高度进行回转取料作业。
S015、调用基于堆取料机动力学模型的恒流量取料控制的控制方法。
具体地,在本步骤中,所调用的动力学模型为步骤S012所得到的动力学模型。调用已经设计完成的基于堆取料机动力学模型的PID控制算法,实时调节悬臂皮带恒流量以达到恒流量的目的。图4所示为该***的控制框图。
具体地,在本步骤中,获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,根据所述实际驱动力矩和所述动力学模型,得到所述斗轮堆取料机的所述回转机构所需调整的目标回转角速度和目标回转角加速度。控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行,以使得所述斗轮堆取料机实现恒流量取料。
本实施例的基于动力学的斗轮堆取料机恒流量取料方法,以堆取料机的动力学数学模型为基础,提出了驱动力矩或者驱动电机电流与角速度和角加速度之间的数学关系,更有利于实现恒流量控制的目的,提高控制精度。本实施例的方法,可以适应于全煤型料堆的自动取料作业,对于不规则或者凹凸不平的料堆也能够完成自动取料的目的。
在一些实施方式中,机器人动力学是对机器人机构的力和运动之间的关系进行研究的科学,主要研究机器人在运动过程中各关节之间的相互作用,即加在机器人各关节的驱动力与各关节的位置、速度、加速度之间的关系。本实施例采用应用非常广泛和成熟的拉格朗日(Lagrange)方法建立斗轮堆取料机的动力学模型。拉格朗日函数如式(1)所示:
L=K-P(1)
式(1)中,K为***的动能,P为***的势能。
拉格朗日第二类方程如下式所示:
利用斗轮堆取料机各连杆位置矢量关系计算得到各驱动机构的动力学模型分别如下所示:
其中,τ=[τ1 τ2 τ3]T代表斗轮堆取料机各转动机构的驱动力矩,τ1为行走机构驱动力矩,τ2为回转机构驱动力矩,τ3为俯仰机构驱动力矩,;M(θ)代表斗轮堆取料机的惯性矩阵;θ、和分别代表各驱动机构转角、角速度和角加速度的三维矢量;代表斗轮堆取料机各驱动机构的离心力及哥氏力系数矩阵;G(θ)=[g1 g2 g3]T代表斗轮堆取料机各驱动机构的重力项。
由式(3)进而得到回转机构驱动力矩和回转、俯仰驱动机构角速度、回转角加速度之间的动力学模型满足下述关系式:
其中,S=sin,C=cos,m2为回转机构的质量,m3为悬臂机构的质量,m4为斗轮支撑机构的质量,m5为斗轮中心支架机构的质量,mw为斗轮机构的质量,l2为俯仰中心至回转中心的距离,l3为悬臂长度,l4为斗轮中心至回转中心的垂直距离,l5为斗轮中心至悬臂中心的水平距离,θ2为回转角度,为回转角速度,为回转角加速度,θ3为悬臂的俯仰角度,为俯仰角速度,为俯仰角加速度。
在一些实施方式中,所述获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,包括:
在所述回转机构上设置转矩测量传感器,根据所述转矩测量传感器得到所述回转机构的实际驱动力矩。
在一些实施方式中,所述获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,包括:
根据所述基本运行数据,计算得到驱动力矩和工作电流之间的关系式;
获取所述回转机构的实际工作电流,根据所述实际工作电流和所述关系式,得到所述回转机构的实际驱动力矩。
具体地,交流电动机转矩和电流之间的关系式如下:
在一些实施方式中,定义加权电流,其满足下述关系式:
IW=IB+AIS
其中,IB为轮斗电机电流、IS为回转电机电流、A为加权系数;对加权电流IW采取分级控制模式,分别为设定值ISV、偏大值IH、过大值IHH、保护值IHHH。
同时选取轮斗电流和回转电机电流作为反馈控制量,不仅可以更大程度上控制恒流量取料的精度,还可以保护轮斗电机和回转电机,防止取料过程中发生过载。回转电机电流或者转矩的大小在一定程度上能够反映出取料流量的变化,本发明采用加权系数的方法处理轮斗电机电流和回转电机电流的作为反馈的作用权重。
S016、当IW∈(0,IH)时,则执行步骤S017、根据计算出的所述目标回转角速度和目标回转角加速度进行恒流量回转取料作业,将输出值维持在设定值ISV附近。
当IW∈(0,IH)不成立时,进入步骤S020、当IW∈[IH,IHH)时,进入步骤S021、自动切除恒流量PID控制策略,停止回转动作;待加权电流IW∈(0,IH)时继续执行步骤S015。当IW∈[IH,IHH)不成立时进入步骤S022、当IW∈[IHH,IHHH)时,一般出现这种情况都是因为料堆有坍塌的情况,则调整大车的位置,自动后退设定的距离,待加权电流IW∈(0,IH)时继续执行步骤S015,并累加和记录自动后退距离以便至下一个回转取料周期中使用。
在取料过程中发生严重的坍塌时导致IW≥IHHH,则进入步骤S024、紧急停机,停止取料作业。
在一些实施方式中,在控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行之前,所述方法还包括:
获取目标料堆的料堆三维模型,并得到所述目标料堆的边界位置信息。根据所述料堆三维模型,计算出分层层数和和每层取料切入点对应的斗轮堆取料机的定位数据,所述定位数据包括行走位置、回转角度和俯仰角度。控制所述斗轮堆取料机移至所述目标料堆的顶层取料切入点,按照计算出的回转角度范围和俯仰高度进行回转取料作业。
一并结合图2,S018、根据三维模型计算出的取料边界信息判断是否到达边界,当悬臂到达料堆边界时,进入步骤S019、斗轮堆取料机大车寸进设定的距离,然后反方向回转取料。
总而言之,本公开适用于条形煤场斗轮堆取料机回转取料的自动控制,以达到恒流量取料的目的。将机器人动力学应用于斗轮堆取料机恒流量取料控制也是在该领域的首创。动力学模型是反映驱动力矩和角速度、角加速度之间数学关系的数学基础。通过精确的数学模型和常规的控制算法就可以达到很好的控制效果。该方法可广泛适用于不同煤种,不同煤型甚至不规则或者凹凸不平煤型的自动取料。该方法在自动取料过程中可根据驱动电机的转矩大小实时调整回转速度,并结合PLC控制程序对电机电流分段保护功能达到全煤型、全煤种、全自动、恒流量取料的目的。
本公开的另一方面,如图5所示,提供一种基于动力学的斗轮堆取料机恒流量取料装置100,该装置100可以适用于前文记载的方法,具体可以参考前文相关记载,在此不作赘述。所述装置100包括:
获取模块110,用于获取斗轮堆取料机的设备机械参数和基本运行数据。
建立模块120,用于根据所述设备机械参数和所述基本运行数据,基于机器人动力学理论建立所述斗轮堆取料机的动力学模型,并建立一种基于动力学模型的PID算法,所述动力学模型用于表征回转机构驱动力矩和回转、俯仰驱动机构角速度及角加速度之间的关系;
计算模块130,用于获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,根据所述实际驱动力矩和所述动力学模型,通过所述PID算法,得到所述斗轮堆取料机的所述回转机构所需调整的目标回转角速度和目标回转角加速度;
控制模块140,用于控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行,以使得所述斗轮堆取料机实现恒流量取料。
本实施例的基于动力学的斗轮堆取料机恒流量取料装置,以堆取料机的动力学数学模型为基础,提出了驱动力矩或者驱动电机电流与角速度和角加速度之间的数学关系,更有利于实现恒流量控制的目的,提高控制精度。本实施例的装置,可以适应于全煤型料堆的自动取料作业,对于不规则或者凹凸不平的料堆也能够完成自动取料的目的。
在一些实施方式中,所述动力学模型满足下述关系式:
其中,S=sin,C=cos,m2为回转机构的质量,m3为悬臂机构的质量,m4为斗轮支撑机构的质量,m5为斗轮中心支架机构的质量,mw为斗轮机构的质量,l2为俯仰中心至回转中心的距离,l3为悬臂长度,l4为斗轮中心至回转中心的垂直距离,l5为斗轮中心至悬臂中心的水平距离,θ2为回转角度,为回转角速度,为回转角加速度,θ3为悬臂的俯仰角度,为俯仰角速度,为俯仰角加速度。
本公开的另一方面,提供一种电子设备,包括:
一个或多个处理器;
存储单元,用于存储一个或多个程序,当所述一个或多个程序被所述一个或多个处理器执行时,能使得所述一个或多个处理器实现根据前文记载的所述的方法。
本公开的另一方面,提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时能实现根据前文记载的所述的方法。
其中,计算机可读介质可以是本公开的装置、设备、***中所包含的,也可以是单独存在。
其中,计算机可读存储介质可是任何包含或存储程序的有形介质,其可以是电、磁、光、电磁、红外线、半导体的***、装置、设备,更具体的例子包括但不限于:具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、光纤、随机访问存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件,或它们任意合适的组合。
其中,计算机可读存储介质也可包括在基带中或作为载波一部分传播的数据信号,其中承载了计算机可读的程序代码,其具体的例子包括但不限于电磁信号、光信号,或它们任意合适的组合。
可以理解的是,以上实施方式仅仅是为了说明本公开的原理而采用的示例性实施方式,然而本公开并不局限于此。对于本领域内的普通技术人员而言,在不脱离本公开的精神和实质的情况下,可以做出各种变型和改进,这些变型和改进也视为本公开的保护范围。
Claims (10)
1.一种基于动力学的斗轮堆取料机恒流量取料方法,其特征在于,所述方法包括:
获取斗轮堆取料机的设备机械参数和基本运行数据;
根据所述设备机械参数和所述基本运行数据,基于机器人动力学理论建立所述斗轮堆取料机的动力学模型,并建立一种基于动力学模型的PID算法;所述动力学模型用于表征回转机构驱动力矩和回转、俯仰驱动机构角速度及角加速度之间的关系;
获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,根据所述实际驱动力矩和所述动力学模型,通过所述PID算法得到所述斗轮堆取料机的所述回转机构所需调整的目标回转角速度和目标回转角加速度;
控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行,以使得所述斗轮堆取料机实现恒流量取料。
3.根据权利要求1所述的方法,其特征在于,所述获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,包括:
在所述回转机构上设置转矩测量传感器,根据所述转矩测量传感器得到所述回转机构的实际驱动力矩。
4.根据权利要求1所述的方法,其特征在于,所述获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,包括:
根据所述基本运行数据,计算得到驱动力矩和工作电流之间的关系式;
获取所述回转机构的实际工作电流,根据所述实际工作电流和所述关系式,得到所述回转机构的实际驱动力矩。
5.根据权利要求4所述的方法,其特征在于,所述工作电流采用加权电流,其满足下述关系式:
IW=IB+AIS
其中,IB为轮斗电机电流、IS为回转电机电流、A为加权系数;对加权电流IW采取分级控制模式,分别为设定值ISV、偏大值IH、过大值IHH、保护值IHHH;
所述控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行,包括:
当IW∈(0,IH)时,则根据计算出的所述目标回转角速度和目标回转角加速度进行恒流量回转取料作业,将输出值维持在设定值ISV附近;
当IW∈[IH,IHH)时,则停止回转动作;待加权电流IW∈(0,IH)时继续执行上述恒流量回转取料作业;
当IW∈[IHH,IHHH)时,则调整大车的行走位置,自动后退设定的距离,待加权电流IW∈(0,IH)时继续执行上述恒流量回转取料作业,并累加和记录自动后退距离以便至下一个回转取料周期中使用;
在取料过程中发生严重的坍塌时导致IW≥IHHH,则紧急停机,停止取料作业。
6.根据权利要求1至5任一项所述的方法,其特征在于,在控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行之前,所述方法还包括:
获取目标料堆的料堆三维模型,并得到所述目标料堆的边界位置信息;
根据所述料堆三维模型,计算出分层层数和和每层取料切入点对应的斗轮堆取料机的定位数据,所述定位数据包括行走位置、回转角度和俯仰角度;
控制所述斗轮堆取料机移至所述目标料堆的顶层取料切入点,按照计算出的回转角度范围和俯仰高度进行回转取料作业;
当悬臂到达料堆边界时,斗轮堆取料机大车寸进设定的距离,然后反方向回转取料;
当上一层取料完毕,斗轮堆取料机自动移动到下一层取料切入点进行回转取料,直至达到预设的取料任务;
并且,在取料过程中控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行。
7.一种基于动力学的斗轮堆取料机恒流量取料装置,其特征在于,所述装置包括:
获取模块,用于获取斗轮堆取料机的设备机械参数和基本运行数据;
建立模块,用于根据所述设备机械参数和所述基本运行数据,基于机器人动力学理论建立所述斗轮堆取料机的动力学模型,并建立一种基于动力学模型的PID算法;所述动力学模型用于表征回转机构驱动力矩和回转、俯仰驱动机构角速度及角加速度之间的关系;
计算模块,用于获取所述斗轮堆取料机的所述回转机构的实际驱动力矩,根据所述实际驱动力矩和所述动力学模型,通过所述PID算法得到所述斗轮堆取料机的所述回转机构所需调整的目标回转角速度和目标回转角加速度;
控制模块,用于控制所述斗轮堆取料机的所述回转机构以所述目标回转角速度和目标回转角加速度运行,以使得所述斗轮堆取料机实现恒流量取料。
9.一种电子设备,其特征在于,包括:
一个或多个处理器;
存储单元,用于存储一个或多个程序,当所述一个或多个程序被所述一个或多个处理器执行时,能使得所述一个或多个处理器实现根据权利要求1至6任一项所述的方法。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时能实现根据权利要求1至6任一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111305107.3A CN113879860B (zh) | 2021-11-05 | 2021-11-05 | 基于动力学的斗轮堆取料机恒流量取料方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111305107.3A CN113879860B (zh) | 2021-11-05 | 2021-11-05 | 基于动力学的斗轮堆取料机恒流量取料方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113879860A true CN113879860A (zh) | 2022-01-04 |
CN113879860B CN113879860B (zh) | 2023-09-08 |
Family
ID=79016575
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111305107.3A Active CN113879860B (zh) | 2021-11-05 | 2021-11-05 | 基于动力学的斗轮堆取料机恒流量取料方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113879860B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114715628A (zh) * | 2022-03-30 | 2022-07-08 | 东北大学 | 一种斗轮堆取料机无人值守方法和调度*** |
CN114803391A (zh) * | 2022-05-12 | 2022-07-29 | 北京华能新锐控制技术有限公司 | 一种智慧燃料***斗轮机无人值守自动取料方法 |
CN114815754A (zh) * | 2022-05-09 | 2022-07-29 | 京能(锡林郭勒)发电有限公司 | 一种自动化料场管控平台 |
Citations (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE4428826A1 (de) * | 1994-08-17 | 1996-02-22 | Axmann Foerdertechnik | Fördereinrichtung und Verfahren zum Betrieb einer Fördereinrichtung |
JPH1067432A (ja) * | 1996-08-28 | 1998-03-10 | Kawasaki Heavy Ind Ltd | バケットホイール式リクレーマの定量切出し制御装置 |
HU9801424D0 (en) * | 1997-06-23 | 1998-08-28 | Man Takraf Foerdertechnik Gmbh | Process and apparatus for the volume limitation of the material flow transferred by a bucket-wheel dredger |
CN101493676A (zh) * | 2008-01-25 | 2009-07-29 | 宝山钢铁股份有限公司 | 带物料测算的斗轮取料机控制方法及控制装置 |
CN101776867A (zh) * | 2009-01-14 | 2010-07-14 | 宝山钢铁股份有限公司 | 一种堆取料机的自动取料控制装置及方法 |
WO2013088533A1 (ja) * | 2011-12-14 | 2013-06-20 | 株式会社安川電機 | モータ制御装置及びモータシステム |
AU2013101229A4 (en) * | 2012-09-14 | 2013-10-10 | 3D Image Automation Pty Ltd | Reclaimer 3D Volume Rate Controller |
US20140044507A1 (en) * | 2012-08-07 | 2014-02-13 | Baker Hughes Incorporated | Apparatus and Methods for Assisting in Controlling Material Delivered on a Conveyor |
CN104020791A (zh) * | 2014-04-23 | 2014-09-03 | 中国神华能源股份有限公司 | 一种煤炭堆场取料流量稳定控制装置及控制方法 |
CN104360635A (zh) * | 2014-10-21 | 2015-02-18 | 南京理工大学 | 一种电机位置伺服***的抗干扰控制方法 |
CN204359477U (zh) * | 2014-12-23 | 2015-05-27 | 武汉理工大学 | 基于plc的斗轮堆取料机悬臂架接地力在线监测*** |
CN105223973A (zh) * | 2014-06-12 | 2016-01-06 | 上海岫峤机电工程有限公司 | 一种斗轮式堆取料机取料流量控制方法和装置 |
CN106483964A (zh) * | 2015-08-31 | 2017-03-08 | 中南大学 | 一种基于接触力观测器的机器人柔顺控制方法 |
CN106853639A (zh) * | 2017-01-04 | 2017-06-16 | 河北工业大学 | 一种手机电池自动化装配***及其控制方法 |
BR102017002299A2 (pt) * | 2017-02-03 | 2018-05-29 | Vale S/A | Sistema e método de controle para recuperadoras |
CN108249173A (zh) * | 2017-12-22 | 2018-07-06 | 中国神华能源股份有限公司 | 取料机斗轮机构的保护控制方法及装置、取料机 |
CN112105781A (zh) * | 2018-02-23 | 2020-12-18 | 利勃海尔比伯拉赫零部件有限公司 | 斗轮式挖掘机和用于控制斗轮式挖掘机的方法 |
CN112722873A (zh) * | 2020-12-23 | 2021-04-30 | 国家能源集团煤焦化有限责任公司 | 堆取料机自动控制*** |
CN113110027A (zh) * | 2021-04-09 | 2021-07-13 | 东南大学 | 一种轨道式斗轮取料机位置切换抗干扰控制方法 |
-
2021
- 2021-11-05 CN CN202111305107.3A patent/CN113879860B/zh active Active
Patent Citations (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE4428826A1 (de) * | 1994-08-17 | 1996-02-22 | Axmann Foerdertechnik | Fördereinrichtung und Verfahren zum Betrieb einer Fördereinrichtung |
JPH1067432A (ja) * | 1996-08-28 | 1998-03-10 | Kawasaki Heavy Ind Ltd | バケットホイール式リクレーマの定量切出し制御装置 |
HU9801424D0 (en) * | 1997-06-23 | 1998-08-28 | Man Takraf Foerdertechnik Gmbh | Process and apparatus for the volume limitation of the material flow transferred by a bucket-wheel dredger |
CN101493676A (zh) * | 2008-01-25 | 2009-07-29 | 宝山钢铁股份有限公司 | 带物料测算的斗轮取料机控制方法及控制装置 |
CN101776867A (zh) * | 2009-01-14 | 2010-07-14 | 宝山钢铁股份有限公司 | 一种堆取料机的自动取料控制装置及方法 |
WO2013088533A1 (ja) * | 2011-12-14 | 2013-06-20 | 株式会社安川電機 | モータ制御装置及びモータシステム |
US20140292248A1 (en) * | 2011-12-14 | 2014-10-02 | Kabushiki Kaisha Yaskawa Denki | Motor controller and motor system |
US20140044507A1 (en) * | 2012-08-07 | 2014-02-13 | Baker Hughes Incorporated | Apparatus and Methods for Assisting in Controlling Material Delivered on a Conveyor |
AU2013101229A4 (en) * | 2012-09-14 | 2013-10-10 | 3D Image Automation Pty Ltd | Reclaimer 3D Volume Rate Controller |
CN104020791A (zh) * | 2014-04-23 | 2014-09-03 | 中国神华能源股份有限公司 | 一种煤炭堆场取料流量稳定控制装置及控制方法 |
CN105223973A (zh) * | 2014-06-12 | 2016-01-06 | 上海岫峤机电工程有限公司 | 一种斗轮式堆取料机取料流量控制方法和装置 |
CN104360635A (zh) * | 2014-10-21 | 2015-02-18 | 南京理工大学 | 一种电机位置伺服***的抗干扰控制方法 |
CN204359477U (zh) * | 2014-12-23 | 2015-05-27 | 武汉理工大学 | 基于plc的斗轮堆取料机悬臂架接地力在线监测*** |
CN106483964A (zh) * | 2015-08-31 | 2017-03-08 | 中南大学 | 一种基于接触力观测器的机器人柔顺控制方法 |
CN106853639A (zh) * | 2017-01-04 | 2017-06-16 | 河北工业大学 | 一种手机电池自动化装配***及其控制方法 |
BR102017002299A2 (pt) * | 2017-02-03 | 2018-05-29 | Vale S/A | Sistema e método de controle para recuperadoras |
CN108249173A (zh) * | 2017-12-22 | 2018-07-06 | 中国神华能源股份有限公司 | 取料机斗轮机构的保护控制方法及装置、取料机 |
CN112105781A (zh) * | 2018-02-23 | 2020-12-18 | 利勃海尔比伯拉赫零部件有限公司 | 斗轮式挖掘机和用于控制斗轮式挖掘机的方法 |
CN112722873A (zh) * | 2020-12-23 | 2021-04-30 | 国家能源集团煤焦化有限责任公司 | 堆取料机自动控制*** |
CN113110027A (zh) * | 2021-04-09 | 2021-07-13 | 东南大学 | 一种轨道式斗轮取料机位置切换抗干扰控制方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114715628A (zh) * | 2022-03-30 | 2022-07-08 | 东北大学 | 一种斗轮堆取料机无人值守方法和调度*** |
CN114815754A (zh) * | 2022-05-09 | 2022-07-29 | 京能(锡林郭勒)发电有限公司 | 一种自动化料场管控平台 |
CN114803391A (zh) * | 2022-05-12 | 2022-07-29 | 北京华能新锐控制技术有限公司 | 一种智慧燃料***斗轮机无人值守自动取料方法 |
CN114803391B (zh) * | 2022-05-12 | 2023-11-03 | 北京华能新锐控制技术有限公司 | 一种智慧燃料***斗轮机无人值守自动取料方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113879860B (zh) | 2023-09-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113879860A (zh) | 基于动力学的斗轮堆取料机恒流量取料方法及装置 | |
CN111487918B (zh) | 基于多线激光雷达的散料无人装车控制方法、***和装置 | |
CN109650089B (zh) | 一种堆场堆取料机与物料堆的防碰撞方法 | |
CN103744425B (zh) | 自动工作设备及其控制方法 | |
CN112537661B (zh) | 一种堆取料机防碰撞控制方法及*** | |
CN104154861A (zh) | 大型堆积物料体积绕行测量装置和方法 | |
CN107089458A (zh) | 一种新型的智能环保垃圾自动回收*** | |
CN102107819A (zh) | 一种集装箱岸边桥吊防摇控制方法 | |
CN113233210B (zh) | 斗轮取料机恒流量自动取料方法及*** | |
CN108147147B (zh) | 一种自动智能化的堆取料*** | |
CN108033279B (zh) | 一种自动堆取料*** | |
WO2023179583A1 (zh) | 一种抑制抓斗摇摆的控制方法、装置、设备及存储介质 | |
CN108182715B (zh) | 一种具有统计堆料场物料信息的堆取料*** | |
CN104528540B (zh) | 臂架式起重机车载控制器内吊装方案实时生成方法及*** | |
CN108726382A (zh) | 一种基于自学习的塔吊及智能避障控制方法 | |
CN109822599A (zh) | 履带式机器人的运动控制方法、装置、***和存储介质 | |
CN108045973B (zh) | 一种堆料***的自动堆料方法 | |
CN114084585A (zh) | 斗轮堆取料机的直行取料方法及装置 | |
CN108128638A (zh) | 一种取料***的自动取料方法 | |
CN116253165A (zh) | 悬臂式斗轮堆取料机的路径规划方法及装置 | |
CN109839942A (zh) | 一种四旋翼无人机自适应姿态控制方法 | |
CN112299122A (zh) | 一种具有减振作用的施工放线机器人及工作方法 | |
CN116578096A (zh) | 一种基于drl的巡检车自适应路径规划方法 | |
CN115319738A (zh) | 用于轴臂组件的控制方法、作业设备、处理器及存储介质 | |
CN114413896A (zh) | 一种移动机器人的复合导航方法、装置、设备及存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |