CN116253165A - 悬臂式斗轮堆取料机的路径规划方法及装置 - Google Patents
悬臂式斗轮堆取料机的路径规划方法及装置 Download PDFInfo
- Publication number
- CN116253165A CN116253165A CN202211105218.4A CN202211105218A CN116253165A CN 116253165 A CN116253165 A CN 116253165A CN 202211105218 A CN202211105218 A CN 202211105218A CN 116253165 A CN116253165 A CN 116253165A
- Authority
- CN
- China
- Prior art keywords
- reclaimer
- coordinate system
- stacker
- point
- point cloud
- 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.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 239000000463 material Substances 0.000 claims abstract description 32
- 238000001514 detection method Methods 0.000 claims abstract description 26
- 230000001131 transforming effect Effects 0.000 claims abstract description 4
- 230000007246 mechanism Effects 0.000 claims description 79
- 230000009466 transformation Effects 0.000 claims description 41
- 239000011159 matrix material Substances 0.000 claims description 36
- 239000012636 effector Substances 0.000 claims description 13
- 238000013519 translation Methods 0.000 claims description 12
- 238000013329 compounding Methods 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 4
- 238000010276 construction Methods 0.000 abstract description 6
- 230000008569 process Effects 0.000 abstract description 5
- 230000006872 improvement Effects 0.000 description 8
- 238000010845 search algorithm Methods 0.000 description 7
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 229910000831 Steel Inorganic materials 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 239000003245 coal Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 239000010959 steel Substances 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
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/02—Loading or unloading machines comprising essentially a conveyor for moving the loads associated with a device for picking-up the loads
- B65G65/04—Loading or unloading machines comprising essentially a conveyor for moving the loads associated with a device for picking-up the loads with pick-up shovels
-
- 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/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
- B65G65/00—Loading or unloading
- B65G65/28—Piling or unpiling loose materials in bulk, e.g. coal, manure, timber, not otherwise provided for
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种悬臂式斗轮堆取料机的路径规划方法及装置,该路径规划方法包括:建立堆取料机的运动学坐标系,并根据坐标系变换得到堆取料机的运动学模型;基于运动学模型建立离散化的运动参数空间、及建立堆取料机在给定运动参数下的简化点云模型;提供碰撞检测算法,通过对简化点云模型与物料堆的整体点云模型进行几何求交,实现对离散化运动参数空间中的每一点的可达性进行判定,并将判定结果为可达的点集合生成三维可达性网格集;于三维可达性网格集中搜索、生成符合要求的运动路径。本发明适用于堆取料机的智能任务规划过程,既为堆取料作业提供了任意给定起点和终点的可通行参考路径,又为堆取料机无人值守***建设奠定了理论基础。
Description
技术领域
本发明涉及自动化和人工智能技术领域,尤其涉及一种悬臂式斗轮堆取料机的路径规划方法及装置。
背景技术
悬臂式斗轮堆取料机(简称堆取料机)是在轨道上运行的大型工业设备,支持大车行走、悬臂回转和悬臂俯仰等多种运动功能,实质上是一类特殊的大型工业机器人,主要用在煤炭和矿石等大宗散状物料的连续堆取料作业中,具体的应用环境包括热电厂、钢铁厂和港口等。
近年来,堆取料机已经从手动控制和半自动控制的方式步入全自动化发展阶段,堆取料机无人值守***也因此成为国内外的关注焦点。无人值守***的一个核心要求是堆取料机能够自主安全抵达料堆的目标点进行堆取料作业,这使得路径规划成为无人值守***需要优先解决的问题。而且,自主规划也是无人值守***智能化水平体现最为充分的一环。
目前,国内外学者针对通用机械臂的路径规划提出了很多方法,但针对堆取料机的路径规划仍然鲜见报道。有鉴于此,特提出本发明。
发明内容
为了克服上述缺陷,本发明提供了一种悬臂式斗轮堆取料机的路径规划方法及装置,既为人工堆取料作业提供了任意给定起点和终点的可通行参考路径,又为悬臂式斗轮堆取料机无人值守***和智慧料场建设奠定了理论基础。
本发明为了解决其技术问题所采用的技术方案是:一种悬臂式斗轮堆取料机的路径规划方法,包括:
建立堆取料机的运动学坐标系,并根据坐标系变换得到堆取料机的运动学模型;
基于该堆取料机的运动学模型建立离散化的运动参数空间、及建立该堆取料机在给定运动参数下的简化点云模型;
提供碰撞检测算法,通过对所得简化点云模型与所述物料堆的整体点云模型进行几何求交,以实现对所述离散化的运动参数空间中的每一点的可达性进行判定,同时将判定结果为可达的点集合生成三维可达性网格集;
于所得三维可达性网格集中搜索、生成符合要求的运动路径。
作为本发明的进一步改进,建立堆取料机的运动学坐标系,并根据坐标系变换得到堆取料机的运动学模型,包括:
建立堆取料机和物料堆所在料场的全局坐标系、及堆取料机上的多个局部坐标系,多个所述局部坐标系分别与堆取料机的多个运动机构一一对应;
获取所述全局坐标系和多个所述局部坐标系中的每任意两个坐标系之间的变换矩阵;
根据上述变换矩阵,得到被配置为末端执行器的一运动机构上的执行点在所述全局坐标系下的坐标;
基于该末端执行器上的执行点移动至物料堆的待处理目标点后,反向求解出该堆取料机的运动学模型。
作为本发明的进一步改进,该堆取料机的多个运动机构包括:斗轮机构,被配置为该堆取料机的末端执行器;所述斗轮机构的斗轮下边缘上的切入点即为所述末端执行器上的执行点;
俯仰机构,被配置为通过悬臂与所述斗轮机构相连接,并同时能够带动所述悬臂及所述斗轮机构一起进行上下运动;
回转机构,被配置为支撑所述俯仰机构,并同时能够带动所述俯仰机构、所述悬臂及所述斗轮机构一起进行左右转动;
行走机构,被配置为支撑所述回转机构,并同时能够支持该堆取料机整机沿水平直线移动;
相应的,多个局部坐标系分别为与所述斗轮机构相对应的斗轮坐标系、与所述俯仰机构相对应的俯仰坐标系、与所述回转机构相对应的回转坐标系、及与所述行走机构相对应的行走坐标系。
作为本发明的进一步改进,所述行走坐标系为所述全局坐标系沿着所述全局坐标系的Y轴方向平移行走距离L后得到,即:所述行走坐标系相对于所述全局坐标系的变换矩阵M01为:
上式中,s1和c1分别为α角度的正弦值和余弦值;
上式中,s2和c2分别为β角度的正弦值和余弦值;
上式中,LA也为悬臂长度;
作为本发明的进一步改进,所述斗轮坐标系下,所述斗轮机构上的执行点的坐标为[0,0,-R,1]T,式中的R为所述斗轮机构上的斗轮半径;
当所述执行点移动至物料堆的待处理目标点后,反向求解,得到该堆取料机的运动学模型为:
L=Py0-c1(c2LA+s2R);
上式中的(Px0,Py0,Pz0)为所述待处理目标点在所述全局坐标系下的坐标,L、α和β分别为该堆取料机的运动学参数。
作为本发明的进一步改进,基于该堆取料机的运动学模型建立离散化的运动参数空间,包括:
给定该堆取料机的运动学模型中的运动学参数的定义域,得到该堆取料机的运动参数空间;
对所得堆取料机的运动参数空间进行采样,生成三维规则网格,即得到离散化的运动参数空间;
基于该堆取料机的运动学模型建立该堆取料机在给定运动参数下的简化点云模型,包括:
在给定运动参数下,根据所述悬臂和所述斗轮机构中的斗轮的轮廓信息,绘制出所述悬臂和所述斗轮的等效图形;
分别对所述悬臂和所述斗轮的等效图形进行离散数据网格化处理,得到所述俯仰坐标系下的悬臂点云模型A、及所述斗轮坐标系下的斗轮点云模型A;
根据变换矩阵,得到所述悬臂点云模型A在所述全局坐标系下的表现形式,并记为悬臂点云模型B;以及得到所述斗轮点云模型A在所述全局坐标系下的表现形式,并记为斗轮点云模型B;
获取所述悬臂点云模型B与所述斗轮点云模型B的并集,即得到该堆取料机的简化点云模型。
作为本发明的进一步改进,所得三维规则网格的表达式为:
Ω={(Li,αj,βk)/i∈[1,I],j∈[1,J],k∈[1,K]},
式中的L、α和β为该堆取料机的运动学参数;I、J和K分别表示各维度的样本数量;
所得并集的表达式为C(L,α,β)。
作为本发明的进一步改进,提供碰撞检测算法,通过对所得简化点云模型与所述物料堆的整体点云模型进行几何求交,以实现对所述离散化的运动参数空间中的每一点的可达性进行判定,同时将判定结果为可达的点集合生成三维可达性网格集;包括:
建立以数字高程模型表示的物料堆的整体点云模型;
遍历所述简化点云模型,得到所述简化点云模型中每一点所对应的高程;
对所述简化点云模型中每一点所对应的高程与其Z向坐标值进行比对,得到每一点的可达性;
将判定结果为可达的点集合生成三维可达性网格集。
作为本发明的进一步改进,对所述简化点云模型中每一点所对应的高程与其Z向坐标值进行比对,得到每一点的可达性,包括:
若某一点所对应的高程小于其Z向坐标值,则判定该点不会发生碰撞、为可达;而若某一点所对应的高程不小于其Z向坐标值,则判定该点会发生碰撞、为不可达;
所得三维可达性网格集的表达式为:
Φ={(Li,αj,βk,Rijk)/Rijk=0,1};
上式中的Rijk代表该堆取料机的运动学模型(Li,αj,βk)的可达性,若:
Rijk=0,表示不可达;
Rijk=1,表示可达。
本发明还提供了一种悬臂式斗轮堆取料机的路径规划装置,包括:第一模型建立模块,用于建立堆取料机的运动学坐标系,并通过坐标系变换得到堆取料机的运动学模型;
第二模型建立模块,用于基于该堆取料机的运动学模型建立离散化的运动参数空间、以及建立该堆取料机在给定运动参数下的简化点云模型;
碰撞检测模块,用于通过对所得简化点云模型与所述物料堆的整体点云模型进行几何求交,以实现对所述离散化的运动参数空间中的每一点的可达性进行判定,同时将判定结果为可达的点集合生成三维可达性网格集;
运动路径生成模块,用于在所述三维可达性网格集中搜索、生成符合要求的运动路径。
本发明的有益效果是:本发明通过先建立堆取料机的运动学模型;再构造堆取料机在给定运动参数下的简化点云模型,并同时提供可实现快速碰撞检测(即可达性检测)的碰撞检测算法;最后利用搜索算法生成安全可靠的运动路径。本发明适用于悬臂式斗轮堆取料机的智能任务规划过程,既为人工堆取料作业提供了任意给定起点和终点的可通行参考路径,又为悬臂式斗轮堆取料机无人值守***和智慧料场建设奠定了理论基础。
附图说明
图1为本发明所述悬臂式斗轮堆取料机的路径规划方法的流程图;
图2为本发明建立堆取料机的运动学模型的流程图;
图3为本发明所述悬臂式斗轮堆取料机的运动学坐标系示意图;
图4为本发明建立堆取料机的简化点云模型的流程图;
图5为本发明进行碰撞检测及生成三维可达性网格集的流程图;
图6为本发明所述悬臂式斗轮堆取料机的路径规划装置的方框示意图。
结合附图,作以下说明:
10、行走机构;11、回转机构;12、俯仰机构;13、斗轮机构;14、悬臂;15、轨道;20、第一模型建立模块;21、第二模型建立模块;22、碰撞检测模块;23、运动路径生成模块。
具体实施方式
以下结合附图,对本发明的一个较佳实施例作详细说明。
实施例1:
请参阅附图1所示,其为本发明所述悬臂式斗轮堆取料机的路径规划方法的流程图。
所述悬臂式斗轮堆取料机的路径规划方法,主要包括以下工作步骤:
S1:建立堆取料机的运动学坐标系,并根据坐标系变换得到堆取料机的运动学模型;
S2:基于该堆取料机的运动学模型建立离散化的运动参数空间、及建立该堆取料机在给定运动参数下的简化点云模型;
S3:提供碰撞检测算法,通过对所得简化点云模型与所述物料堆的整体点云模型进行几何求交,以实现对所述离散化的运动参数空间中的每一点的可达性进行判定,同时将判定结果为可达的点集合生成三维可达性网格集;
S4:于所得三维可达性网格集中搜索、生成符合要求的运动路径。
本发明通过先建立堆取料机的运动学模型;再构造堆取料机在给定运动参数下的简化点云模型,并同时提供可实现快速碰撞检测(即可达性检测)的碰撞检测算法;最后利用搜索算法生成安全可靠的运动路径。本发明适用于悬臂式斗轮堆取料机的智能任务规划过程,既为人工堆取料作业提供了任意给定起点和终点的可通行参考路径,又为悬臂式斗轮堆取料机无人值守***和智慧料场建设奠定了理论基础。
实施例2:
请参阅附图2所示,其为本发明建立堆取料机的运动学模型的流程图。
所述堆取料机的运动学模型建立,主要包括以下工作步骤:
S11:建立堆取料机和物料堆所在料场的全局坐标系、及堆取料机上的多个局部坐标系,多个所述局部坐标系分别与堆取料机的多个运动机构一一对应。
公知的,悬臂式斗轮堆取料机包括行走机构10、回转机构11、俯仰机构12和斗轮机构13等多个运动机构,其中,所述行走机构10被配置为能够支持该堆取料机整机沿水平直线移动;所述回转机构11被配置为设置于所述行走机构10上,所述俯仰机构12被配置为设置于所述回转机构11上,并能够在所述回转机构11的带动下进行左右转动;所述斗轮机构13被配置为该堆取料机的末端执行器,所述斗轮机构13的斗轮下边缘上的切入点即为所述末端执行器上的执行点;所述斗轮机构13通过悬臂14与所述俯仰机构12相连接,并能够在所述俯仰机构12的带动下进行一定角度内的上下运动。
相应的,多个局部坐标系分别为与所述斗轮机构13相对应的斗轮坐标系、与所述俯仰机构12相对应的俯仰坐标系、与所述回转机构11相对应的回转坐标系、及与所述行走机构10相对应的行走坐标系,具体可参阅附图3所示。
S12:获取所述全局坐标系和多个所述局部坐标系中的每任意两个坐标系之间的变换矩阵。
具体的,见附图3所示,定义料场(为悬臂式斗轮堆取料机的工作场所)的全局坐标系为O0-X0Y0Z0,原点位于轨道15上,所述轨道15为堆取料机的所述行走机构10行走的轨道。
所述回转坐标系O2-X2Y2Z2为所述行走坐标系O1-X1Y1Z1依次沿着所述行走坐标系的Z1轴方向平移距离LY、及绕着所述行走坐标系的Z1轴旋转α角度(也就是在水平面上进行左右旋转α角度)后得到,也就是说,所述行走坐标系O1-X1Y1Z1通过两次变换得到所述回转坐标系O2-X2Y2Z2,首先所述行走坐标系O1-X1Y1Z1沿着其Z1轴方向平移距离LY,得到中间坐标系O'2-X'2Y'2Z'2,然后再将中间坐标系O'2-X'2Y'2Z'2绕着其Z'2轴(平行于所述行走坐标系的Z1轴)旋转α角度。
上式中,s1和c1分别为α角度(也称为回转关节角度)的正弦值和余弦值;
所述俯仰坐标系O3-X3Y3Z3为所述回转坐标系O2-X2Y2Z2依次沿着所述回转坐标系的Z2轴方向平移距离LPY、及绕着所述回转坐标系的X2轴旋转β角度(也就是在竖直面上进行上下摆动)后得到,也就是说所述回转坐标系O2-X2Y2Z2也是通过两次变换得到所述俯仰坐标系O3-X3Y3Z3的,首先所述回转坐标系O2-X2Y2Z2沿着其Z2轴方向平移距离LPY得到中间坐标系O'3-X'3Y'3Z'3,然后再将中间坐标系O'3-X'3Y'3Z'3绕其X'3轴(平行于所述回转坐标系的X2轴)旋转β角度。
上式中,s2和c2分别为β角度(也称为俯仰关节角度)的正弦值和余弦值。
上式中,LA也为所述悬臂(14)的长度;
S13:根据上述变换矩阵,得到被配置为末端执行器的一运动机构上的执行点在所述全局坐标系下的坐标(即为运动学正向模型)。
由上述S11可知,所述斗轮机构13被配置为该堆取料机的末端执行器,所述斗轮机构13中的斗轮下边缘上的切入点Q即为所述执行点。
令所述斗轮的半径为R,那么在所述斗轮坐标系下,所述斗轮机构13上的执行点Q的坐标为[0,0,-R,1]T。
上述表达式实际也为运动学正向模型。
S14:基于该末端执行器上的执行点Q移动至物料堆的待处理目标点P后,反向求解出该堆取料机的运动学模型。
具体的,当所述执行点Q移动至物料堆的待处理目标点P后,所述待处理目标点P在所述全局坐标系下的坐标为(Px0,Py0,Pz0),反向求解,得到该堆取料机的运动学模型为:
L=Py0-c1(c2LA+s2R)。
由该堆取料机的运动学模型可以看出,运动参数(L,α,β)至多存在四组解(运动学参数L、α和β分别为行走距离、回转关节角度和俯仰关节角度)。显然,可行解必须保证参数落入定义域内且无碰撞发生。如果存在多组可行解,可以基于最小变化原则筛选出一组最合理的解。如果不存在可行解,则待处理目标位置不可达。
实施例3:
通常情况下,料场中的物料堆是分布在轨道15两侧的,轨道15为堆取料机的所述行走机构10行走的轨道,与物料堆发生碰撞的机构必须具有回转和俯仰自由度。因所述回转机构11和所述俯仰机构12的支撑部分只能在轨道15范围内回转,所以不会发生碰撞,因此只有所述悬臂14、所述斗轮和所述俯仰机构12的配重部分存在碰撞可能性。再结合配重部分的高度、其俯仰角度的变动范围和物料堆的斜坡形状分布,配重部分基本不存在碰撞风险。因而,从碰撞检测的角度,只需描述所述悬臂14和所述斗轮分别与料堆的位置关系即可。
首先,基于该堆取料机的运动学模型建立离散化的运动参数空间,具体包括以下工作步骤:
S211:给定该堆取料机的运动学模型中的运动学参数的定义域,得到该堆取料机的运动参数空间;
S212:对所得堆取料机的运动参数空间进行采样,生成三维规则网格,即得到离散化的运动参数空间。
如以该堆取料机的运动学参数的定义域为:L∈[0m,300m],α∈[-120°,120°],β∈[-30°,30°]为例,对参数进行采样,生成三维规则网格Ω={(Li,αj,βk)/i∈[1,I],j∈[1,J],k∈[1,K]},式中的L、α和β为该堆取料机的运动学参数,I、J和K分别表示各维度的样本数量。Ω是离散化的运动参数空间,如果样本数量的取值越大,则采样间距越小,参数采样越稠密。
基于所得到的离散化的运动参数空间,当给定了运动参数空间中的一个采样点后,就是给定了一组运动参数(行走距离L、回转关节角度α和俯仰关节角度β)的取值。对于每一组运动参数,都可以建立该堆取料机在该运动参数下的简化点云模型。
具体的,建立该堆取料机在给定运动参数下的简化点云模型,包括以下工作步骤:请参阅附图4所示,
S221:在给定运动参数下,根据所述悬臂14和所述斗轮机构13中的斗轮的轮廓信息,绘制出所述悬臂14和所述斗轮的等效图形;
为提高碰撞检测的效率,将所述悬臂14和所述斗轮机构13中的斗轮的三维模型进行等效简化。所述悬臂14等效为“长为LA、宽为WA、高为HA”的矩形,长LA沿着坐标轴Y3方向,高HA沿着坐标轴X3方向,宽WA沿着坐标轴Z3方向,俯仰坐标系的原点O3位于该矩形左侧表面的中心;所述斗轮等效为“半径为R、高为H”的圆柱,高H沿着坐标轴Xt方向,斗轮坐标系的原点Ot位于圆柱的中心。
S222:分别对所述悬臂14和所述斗轮的等效图形进行离散数据网格化处理(比如可采用三角形网格化处理),得到所述俯仰坐标系下的悬臂点云模型A、及所述斗轮坐标系下的斗轮点云模型A;
S224:获取所述悬臂点云模型B与所述斗轮点云模型B的并集,即得到该堆取料机的简化点云模型。
具体的,所得并集的表达式为C(L,α,β),式中的L、α和β为该堆取料机的运动学参数。简言之,简化点云模型就是所述悬臂和所述斗轮的包围盒,并以点云模型的形式给出。
实施例4:
请参阅附图5所示,其为本发明进行碰撞检测及生成三维可达性网格集的流程图。
所述进行碰撞检测及生成三维可达性网格集,包括以下工作步骤:
S31:建立以数字高程模型DEM表示的物料堆的整体点云模型;
关于物料堆的整体点云数据的获取,可通过多种方式来获得,比如可通过激光雷达扫描采集的方式获得。
S32:遍历所述简化点云模型为C(L,α,β),根据所述简化点云模型中每一点的坐标插值,计算得到所述简化点云模型中每一点所对应的高程;
S33:对所述简化点云模型中每一点所对应的高程与其Z向坐标值进行比对,得到每一点的可达性;
具体为:若某一点所对应的高程小于其Z向坐标值,则判定该点不会发生碰撞、为可达;而若某一点所对应的高程不小于其Z向坐标值,则判定该点会发生碰撞、为不可达;
S34:将判定结果为可达的点集合生成三维可达性网格集,所得三维可达性网格集的表达式为:Φ={(Li,αj,βk,Rijk)/Rijk=0,1};
上式中的Rijk代表该堆取料机的运动学模型(Li,αj,βk)的可达性,若:Rijk=0,表示不可达;Rijk=1,表示可达。
本实施例中,上述碰撞检测的工作过程实质上是独立的,因此可利用GPU的并行能力来快速判定所述简化点云模型中每一个点的可达性,以生成三维可达性网格集Φ。总之,上述碰撞检测的工作效率高,可很好满足实时任务规划需求,为堆取料机无人值守***建设创造了基础条件。
实施例5:
路径规划的本质是生成一条从起点到终点的离散路径,当然路径中的每一个点都必须是可达的。通常情况下,路径的起点的运动参数和位置都是已知的,路径的终点是指定位置。
本实施例中,利用该堆取料机的运动学模型可以为终点找到一组或几组关于运动参数的可行解。若:起点参数为(Lstart,αstart,βstart),终点参数为(Lend,αend,βend),与它们最近的网格元素分别为(Li0,αj0,βk0)和(Li1,αj1,βk1),显然只需找到(Li0,αj0,βk0)和(Li1,αj1,βk1)之间的一条路径即可。
工作时,基于给定的三维可达性网格集Φ,利用搜索算法进行路径搜索,搜索算法可采用A星算法、RTT路径搜索算法和PRM路径搜索算法中的一种。并且在路径搜索时还要定义网格点间的距离D,本例采用带权重的欧式距离D:
上式中,ωL,ωα,ωβ分别为行走距离、回转关节角度和俯仰关节角度的权重。考虑到行走的耗能相对较大,行走距离的权重是其它两个参数的两倍:ωL=2,ωα=1,ωβ=1,以保证搜索时回转和俯仰优先。
实施例6:
本实施例提供了一种悬臂式斗轮堆取料机的路径规划装置,见附图6所示,包括:
第一模型建立模块20,用于建立堆取料机的运动学坐标系,并通过坐标系变换得到堆取料机的运动学模型;
第二模型建立模块21,用于基于该堆取料机的运动学模型建立离散化的运动参数空间、以及建立该堆取料机在给定运动参数下的简化点云模型;
碰撞检测模块22,用于通过对所得简化点云模型与所述物料堆的整体点云模型进行几何求交,以实现对所述离散化的运动参数空间中的每一点的可达性进行判定,同时将判定结果为可达的点集合生成三维可达性网格集;
运动路径生成模块23,用于在所述三维可达性网格集中搜索、生成符合要求的运动路径。
本实施例所提供的悬臂式斗轮堆取料机的路径规划装置可执行本发明任意实施例所提供的悬臂式斗轮堆取料机的路径规划方法,并具备执行方法相应的有益效果。
综上所述,本发明通过先建立堆取料机的运动学模型;再构造堆取料机在给定运动参数下的简化点云模型,并同时提供可实现快速碰撞检测(即可达性检测)的碰撞检测算法;最后利用搜索算法生成安全可靠的运动路径。本发明适用于悬臂式斗轮堆取料机的智能任务规划过程,既为人工堆取料作业提供了任意给定起点和终点的可通行参考路径,又为悬臂式斗轮堆取料机无人值守***和智慧料场建设奠定了理论基础。
在以上的描述中阐述了很多具体细节以便于充分理解本发明。但是以上描述仅是本发明的较佳实施例而已,本发明能够以很多不同于在此描述的其它方式来实施,因此本发明不受上面公开的具体实施的限制。同时任何熟悉本领域技术人员在不脱离本发明技术方案范围情况下,都可利用上述揭示的方法和技术内容对本发明技术方案做出许多可能的变动和修饰,或修改为等同变化的等效实施例。凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所做的任何简单修改、等同变化及修饰,均仍属于本发明技术方案保护的范围内。
Claims (10)
1.一种悬臂式斗轮堆取料机的路径规划方法,其特征在于:包括:
建立堆取料机的运动学坐标系,并根据坐标系变换得到堆取料机的运动学模型;
基于该堆取料机的运动学模型建立离散化的运动参数空间、及建立该堆取料机在给定运动参数下的简化点云模型;
提供碰撞检测算法,通过对所得简化点云模型与所述物料堆的整体点云模型进行几何求交,以实现对所述离散化的运动参数空间中的每一点的可达性进行判定,同时将判定结果为可达的点集合生成三维可达性网格集;
于所得三维可达性网格集中搜索、生成符合要求的运动路径。
2.根据权利要求1所述的悬臂式斗轮堆取料机的路径规划方法,其特征在于:建立堆取料机的运动学坐标系,并根据坐标系变换得到堆取料机的运动学模型,包括:
建立堆取料机和物料堆所在料场的全局坐标系、及堆取料机上的多个局部坐标系,多个所述局部坐标系分别与堆取料机的多个运动机构一一对应;
获取所述全局坐标系和多个所述局部坐标系中的每任意两个坐标系之间的变换矩阵;
根据上述变换矩阵,得到被配置为末端执行器的一运动机构上的执行点在所述全局坐标系下的坐标;
基于该末端执行器上的执行点移动至物料堆的待处理目标点后,反向求解出该堆取料机的运动学模型。
3.根据权利要求2所述的悬臂式斗轮堆取料机的路径规划方法,其特征在于:该堆取料机的多个运动机构包括:
斗轮机构(13),被配置为该堆取料机的末端执行器;所述斗轮机构(13)的斗轮下边缘上的切入点即为所述末端执行器上的执行点;
俯仰机构(12),被配置为通过悬臂(14)与所述斗轮机构(13)相连接,并同时能够带动所述悬臂(14)及所述斗轮机构(13)一起进行上下运动;
回转机构(11),被配置为支撑所述俯仰机构(12),并同时能够带动所述俯仰机构(12)、所述悬臂(14)及所述斗轮机构(13)一起进行左右转动;
行走机构(10),被配置为支撑所述回转机构(11),并同时能够支持该堆取料机整机沿水平直线移动;
相应的,多个局部坐标系分别为与所述斗轮机构(13)相对应的斗轮坐标系、与所述俯仰机构(12)相对应的俯仰坐标系、与所述回转机构(11)相对应的回转坐标系、及与所述行走机构(10)相对应的行走坐标系。
4.根据权利要求3所述的悬臂式斗轮堆取料机的路径规划方法,其特征在于:所述行走坐标系为所述全局坐标系沿着所述全局坐标系的Y轴方向平移行走距离L后得到,即:所述行走坐标系相对于所述全局坐标系的变换矩阵为:
上式中,s1和c1分别为α角度的正弦值和余弦值;
上式中,s2和c2分别为β角度的正弦值和余弦值;
上式中,LA也为悬臂长度;
6.根据权利要求3所述的悬臂式斗轮堆取料机的路径规划方法,其特征在于:基于该堆取料机的运动学模型建立离散化的运动参数空间,包括:
给定该堆取料机的运动学模型中的运动学参数的定义域,得到该堆取料机的运动参数空间;
对所得堆取料机的运动参数空间进行采样,生成三维规则网格,即得到离散化的运动参数空间;
基于该堆取料机的运动学模型建立该堆取料机在给定运动参数下的简化点云模型,包括:
在给定运动参数下,根据所述悬臂(14)和所述斗轮机构(13)中的斗轮的轮廓信息,绘制出所述悬臂(14)和所述斗轮的等效图形;
分别对所述悬臂(14)和所述斗轮的等效图形进行离散数据网格化处理,得到所述俯仰坐标系下的悬臂点云模型A、及所述斗轮坐标系下的斗轮点云模型A;
根据变换矩阵,得到所述悬臂点云模型A在所述全局坐标系下的表现形式,并记为悬臂点云模型B;以及得到所述斗轮点云模型A在所述全局坐标系下的表现形式,并记为斗轮点云模型B;
获取所述悬臂点云模型B与所述斗轮点云模型B的并集,即得到该堆取料机的简化点云模型。
7.根据权利要求6所述的悬臂式斗轮堆取料机的路径规划方法,其特征在于:所得三维规则网格的表达式为:
Ω={(Li,αj,βk)/i∈[1,I],j∈[1,J],k∈[1,K]},
式中的L、α和β为该堆取料机的运动学参数;I、J和K分别表示各维度的样本数量;
所得并集的表达式为C(L,α,β)。
8.根据权利要求6所述的悬臂式斗轮堆取料机的路径规划方法,其特征在于:提供碰撞检测算法,通过对所得简化点云模型与所述物料堆的整体点云模型进行几何求交,以实现对所述离散化的运动参数空间中的每一点的可达性进行判定,同时将判定结果为可达的点集合生成三维可达性网格集;包括:
建立以数字高程模型表示的物料堆的整体点云模型;
遍历所述简化点云模型,得到所述简化点云模型中每一点所对应的高程;
对所述简化点云模型中每一点所对应的高程与其Z向坐标值进行比对,得到每一点的可达性;
将判定结果为可达的点集合生成三维可达性网格集。
9.根据权利要求8所述的悬臂式斗轮堆取料机的路径规划方法,其特征在于:对所述简化点云模型中每一点所对应的高程与其Z向坐标值进行比对,得到每一点的可达性,包括:
若某一点所对应的高程小于其Z向坐标值,则判定该点不会发生碰撞、为可达;而若某一点所对应的高程不小于其Z向坐标值,则判定该点会发生碰撞、为不可达;
所得三维可达性网格集的表达式为:
Φ={(Li,αj,βk,Rijk)/Rijk=0,1};
上式中的Rijk代表该堆取料机的运动学模型(Li,αj,βk)的可达性,若:
Rijk=0,表示不可达;
Rijk=1,表示可达。
10.一种悬臂式斗轮堆取料机的路径规划装置,其特征在于:包括:
第一模型建立模块(20),用于建立堆取料机的运动学坐标系,并通过坐标系变换得到堆取料机的运动学模型;
第二模型建立模块(21),用于基于该堆取料机的运动学模型建立离散化的运动参数空间、以及建立该堆取料机在给定运动参数下的简化点云模型;
碰撞检测模块(22),用于通过对所得简化点云模型与所述物料堆的整体点云模型进行几何求交,以实现对所述离散化的运动参数空间中的每一点的可达性进行判定,同时将判定结果为可达的点集合生成三维可达性网格集;
运动路径生成模块(23),用于在所述三维可达性网格集中搜索、生成符合要求的运动路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211105218.4A CN116253165A (zh) | 2022-09-09 | 2022-09-09 | 悬臂式斗轮堆取料机的路径规划方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211105218.4A CN116253165A (zh) | 2022-09-09 | 2022-09-09 | 悬臂式斗轮堆取料机的路径规划方法及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116253165A true CN116253165A (zh) | 2023-06-13 |
Family
ID=86685098
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211105218.4A Withdrawn CN116253165A (zh) | 2022-09-09 | 2022-09-09 | 悬臂式斗轮堆取料机的路径规划方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116253165A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116620802A (zh) * | 2023-07-19 | 2023-08-22 | 中建安装集团有限公司 | 一种利用室内施工智能物料运输***的运输方法 |
CN117485929A (zh) * | 2023-12-29 | 2024-02-02 | 中国电力工程顾问集团西南电力设计院有限公司 | 一种基于智能控制的无人化堆取料控制***及方法 |
-
2022
- 2022-09-09 CN CN202211105218.4A patent/CN116253165A/zh not_active Withdrawn
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116620802A (zh) * | 2023-07-19 | 2023-08-22 | 中建安装集团有限公司 | 一种利用室内施工智能物料运输***的运输方法 |
CN116620802B (zh) * | 2023-07-19 | 2023-10-24 | 中建安装集团有限公司 | 一种利用室内施工智能物料运输***的运输方法 |
CN117485929A (zh) * | 2023-12-29 | 2024-02-02 | 中国电力工程顾问集团西南电力设计院有限公司 | 一种基于智能控制的无人化堆取料控制***及方法 |
CN117485929B (zh) * | 2023-12-29 | 2024-03-19 | 中国电力工程顾问集团西南电力设计院有限公司 | 一种基于智能控制的无人化堆取料控制***及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN116253165A (zh) | 悬臂式斗轮堆取料机的路径规划方法及装置 | |
CN109650089B (zh) | 一种堆场堆取料机与物料堆的防碰撞方法 | |
CN112537661B (zh) | 一种堆取料机防碰撞控制方法及*** | |
CN110815180B (zh) | 六自由度并联机器人运动分析建模及快速求解方法 | |
CN103090791B (zh) | 散堆物料的测量***、方法、装置和堆取料控制*** | |
CN109650090A (zh) | 一种取料机取料控制方法及装置 | |
CN114545877B (zh) | 一种面向散货的多工程机械数字孪生在线监控***及方法 | |
CN104090279B (zh) | 一种基于激光雷达的挖掘作业面检测装置 | |
CN109918756B (zh) | Bim仿真技术在烧结室行车安装作业中的应用方法 | |
CN112938517A (zh) | 基于uwb定位技术的斗轮机无人值守控制***及方法 | |
CN114898540B (zh) | 一种基于几何部件模型的散料货场设备防碰撞预警方法 | |
CN113565165B (zh) | 挖掘机电子围墙的建立方法 | |
Huang et al. | Point cloud based path planning for tower crane lifting | |
Shen et al. | A robotic system for surface measurement via 3d laser scanner | |
CN115571584A (zh) | 一种斗轮机模型防碰撞方法及*** | |
Lei et al. | Application of robotic obstacle avoidance in crane lift path planning | |
CN115544768A (zh) | 一种自主挖掘作业轨迹生成方法及*** | |
CN115008475A (zh) | 一种基于混合几何表征的双机械臂协同避障运动规划优化方法 | |
CN116477374A (zh) | 悬臂式斗轮堆取料机的精调控制方法及装置 | |
CN113223168A (zh) | 一种隧道三维形貌快速建模的方法 | |
Du et al. | Scenario modeling and operation path planning of autonomous driving tower cranes | |
CN114067080B (zh) | 一种获取料堆高程模型的方法及*** | |
CN115795580B (zh) | 基于云计算的智能开挖施工管理*** | |
CN116163755A (zh) | 一种掘进机智能截割轨迹规划方法、***、设备及介质 | |
CN116380081B (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 | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20230613 |
|
WW01 | Invention patent application withdrawn after publication |