CN110221574A - 单机防碰撞的方法和系统 - Google Patents
单机防碰撞的方法和系统 Download PDFInfo
- Publication number
- CN110221574A CN110221574A CN201910498462.3A CN201910498462A CN110221574A CN 110221574 A CN110221574 A CN 110221574A CN 201910498462 A CN201910498462 A CN 201910498462A CN 110221574 A CN110221574 A CN 110221574A
- Authority
- CN
- China
- Prior art keywords
- single machine
- line segment
- projected image
- angle
- anticollision
- 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
- 238000000034 method Methods 0.000 title claims abstract description 47
- 230000003139 buffering effect Effects 0.000 claims description 17
- 239000000872 buffer Substances 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 abstract description 5
- 230000008901 benefit Effects 0.000 abstract description 4
- 238000004519 manufacturing process Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 230000001276 controlling effect Effects 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 230000001960 triggered effect Effects 0.000 description 2
- 238000010977 unit operation Methods 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/05—Programmable logic controllers, e.g. simulating logic interconnections of signals according to ladder diagrams or function charts
- G05B19/054—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/10—Plc systems
- G05B2219/13—Plc programming
- G05B2219/13004—Programming the plc
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- General Factory Administration (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
本发明提供一种单机防碰撞的方法和系统,属于自动控制技术领域。所述单机防碰撞的方法包括:获取堆场内全部单机的行走位置信息和回转角度信息;根据单机的行走位置信息和回转角度信息确定所述单机在堆场地面的投影图像;以及判断不同单机的投影图像之间是否有重叠点,在所述不同单机的投影图像之间有重叠点时,采取防碰撞操作。采用本发明提供的技术方案,根据单机的行走位置信息和回转角度信息确定对场内自动运行的单机之间是否可能会发生碰撞,并在单机之间发生碰撞之前采取防碰撞操作以保护单机安全,有效保护单机远程自动作业时和全天候无人值守时的单机设备安全,还具有节约成本和提高生产效率的优点。
Description
技术领域
本发明涉及自动控制技术领域,具体地涉及一种单机防碰撞的方法和系统。
背景技术
当前的堆场单机朝着自动化和智能化的方向飞速发展,现有的堆场单机已经基本实现全天候无人值守,操作员在集控室通过视频监控系统远程监护单机的自动作业,工作模式为一名操作员监护多台单机,这就对堆场单机防碰撞系统的可靠性和准确性提出了很高的要求。
现有的堆场单机防碰撞系统主要有两种算法,第一种是利用平面上点和点的距离,判断单机是否可能发生碰撞,这种方法计算较为简便,但是精度较低,保护范围过大,邻垛作业等情况容易受影响,第二种是基于分离轴算法的多边形碰撞检测,但是这种算法只适用于凸多边形,而且计算复杂,利用现有条件使用该方法的难度较高,不易于实现。
发明内容
本发明实施例的目的是提供一种单机防碰撞的方法和单机防碰撞的系统,用于解决上述技术问题中的一者或多者。
为了实现上述目的,本发明实施例提供一种单机防碰撞的方法,所述方法包括:获取堆场内全部单机的行走位置信息和回转角度信息;根据单机的行走位置信息和回转角度信息确定所述单机在堆场地面的投影图像;以及判断不同单机的投影图像之间是否有重叠点,在所述不同单机的投影图像之间有重叠点时,采取防碰撞操作。
可选的,所述方法还包括:根据单机的行走位置信息和回转角度信息确定所述单机在堆场地面的投影图像以后,在所述投影图像中增加缓冲余量以生成具有缓冲余量的投影图像;判断不同单机的具有缓冲余量的投影图像之间是否有重叠点;以及在不同单机的具有缓冲余量的投影图像之间有重叠点时,采取防碰撞操作。
可选的,所述在投影图像中增加缓冲余量以生成具有缓冲余量的投影图像包括:将单机的臂架和配重的长度和宽度都增加预设距离后得到的投影图像作为所述具有缓冲余量的投影图像。
可选的,所述方法还包括:确定回转角度处于预设角度范围之内的单机不会与周围其它的单机发生碰撞。
可选的,通过以下方式根据单机的行走位置信息和回转角度信息确定所述单机在堆场地面的投影图像:以所述堆场地面为对象建立平面直角坐标系;根据单机的行走位置、臂架长度、配重长度和回转角度,确定所述单机的投影图像在所述平面之间坐标系中的函数表达式。
可选的,所述方法还包括:在多个单机处于所述堆场内的同一轨道时,确定单机的投影图像在坐标轴上的投影的两个端点值的坐标;以及在某一单机的两个端点值的坐标值全部大于另一单机的两个端点值的坐标值时,确定这两个单机之间不能发生碰撞,否则采取防碰撞操作。
可选的,所述方法还包括:在多个单机处于堆场内的不同轨道时,确定与单机的投影图像的轮廓对应的第一线段和第二线段的函数表达式,所述第一线段与所述第二线段相平行,且所述第一线段和所述第二线段的方向为所述单机的投影图像中沿臂架至配重的方向;确定第一单机的投影图像中的第一线段和第二线段是否与处于不同轨道的第二单机的投影图像中的第一线段和第二线段互相平行;在第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间不平行时,判断所述第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间是否具有交点;以及所述第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间具有交点时,采取防碰撞操作。
可选的,所述方法还包括:在第一单机的投影图像中的第一线段和第二线段与处于不同轨道的第二单机的投影图像中的第一线段和第二线段之间相互平行时,获取所述第一单机与所述第二单机的投影图像在坐标轴上的投影的两个端点值的坐标;以及在所述第一单机的两个端点值的坐标值全部大于或小于所述第二单机的两个端点值的坐标值时,确定所述第一单机与所述第二单机之间不能发生碰撞,否则采取防碰撞操作。
可选的,在两个单机的回转角度之和为预设范围时,确定所述两个单机的投影图像中的第一线段之间和第二线段之间处于相互平行的状态。
相应的,本发明实施例还提供一种单机防碰撞系统,所述系统包括控制模块和位于单机的可编程逻辑控制器,所述可编程逻辑控制器用于采集单机的行走位置信息和回转角度信息,并将所述行走位置信息和回转角度信息发送至所述控制模块;控制模块,用于执行根据上述中任一项所述的单机防碰撞的方法。
通过上述技术方案,可以根据单机的行走位置信息和回转角度信息确定对场内自动运行的单机之间是否可能会发生碰撞,并在单机之间发生碰撞之前采取防碰撞操作以保护单机安全,有效保护单机远程自动作业和全天候无人值守时的单机设备安全,节省了班组人员的人工成本,降低了班组人员的工作压力,还能够有效提供生产效率。
本发明实施例的其它特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本发明实施例的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本发明实施例,但并不构成对本发明实施例的限制。在附图中:
图1是本发明实施例提供的单机防碰撞的方法的流程示意图;
图2是单机在堆场地面的投影图像示意图;
图3是本发明实施例提供的单机防碰撞的系统的结构框图。
具体实施方式
以下结合附图对本发明实施例的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明实施例,并不用于限制本发明实施例。
图1是本发明实施例提供的单机防碰撞的方法的流程示意图。如图1所示,所述单机防碰撞的方法包括步骤S102至S106。
步骤S102,获取对场内全部单机的行走位置信息和回转角度信息。
对于堆场和单机来说,一般会设置一个用于调控堆场内各个设备的总控制器,而每个单机都会设置一个用于控制单机本身和与总控制器进行通讯的子控制器。在堆场内的单机工作过程中,可以先通过子控制器采集与其对应的单机的行走位置信息和回转角度信息,并将其传送至总控制器,通过这种方式,总控制器就可以接收堆场内的全部单机的行走位置信息和回转角度信息。
可选的,针对单机作业的堆场可以设置一个总PLC控制系统,针对每一个单机都设置一个子PLC控制系统,总PLC控制系统与子PLC控制系统之间的全部数据传输都可以通过PLC控制系统中的信息传输指令MSG完成。
在总PLC控制系统接收到由子PLC控制系统实时传送的堆场内全部单机的行走位置信息和回转角度信息后,可以自动执行下述步骤S104至步骤S106中的全部操作。
其中,行走位置信息可以包含单机当前的所在轨道、位置信息以及作业行程信息。
步骤S104,根据单机的行走位置信息和回转角度信息确定单机在堆场地面的投影图像。
单机包括臂架和配重,可以围绕中心旋转,并且在轨道上行走。因此单机在堆场地面的投影图像由单机的配重的投影图像和臂架的投影图像构成,臂架的投影图像和配重的投影图像相连接的点可以设定为中心点。
本发明该实施例还提供一种根据单机的行走位置信息和回转角度信息确定单机在堆场地面的投影方法,所述方法包括:先以堆场地面为对象建立一平面直角坐标系,再根据单机的行走位置、臂架长度、配重长度和回转角度等信息,确定单机的投影图像在平面直角坐标系中的函数表达式。
为了便于后期的数据计算和处理,优选以堆场地面为对象建立一平面直角坐标系,所述平面直角坐标系的原点可以为堆场地面的任意一点。优选的,为了能够简化待处理数据的复杂度,可以平面直角坐标系中的横坐标和纵坐标分别与轨道平行或者垂直,进一步的,可以以堆场的边缘的某个定点为坐标原点,以使得整个堆场地面都位于同一个象限内部,例如设置堆场的东南角为直角坐标系的原点。
单机在堆场地面的投影图像如图2所示,图2中平行于X轴的横线为轨道,单机的投影图像为一个四边形,并且投影图像的中心位于轨道上。
步骤S106,判断不同单机的投影图像之间是否有重叠点,在不同单机的投影图像之间有重叠点时,采取防碰撞操作。
考虑到信号传输延迟和单机工作惯性等因素,为了避免单机之间发生碰撞,还可以以单机的投影图像为基础增加适当的缓冲余量,即将构成投影图像的四边形的四条边均适当延长,并根据延长后的四边形进行计算和处理,以确定单机之间是否可能会发生碰撞。
对位于同一轨道的多个单机来说,只要多个投影图像的端点没有接触,就能确定多个投影图像没有重叠点,不可能发生碰撞。
在此基础上,对位于同一轨道的两个相邻单机来说,只需要确定投影图像中的端点值对应的坐标即可,在一个单机的两个端点值的坐标全部大于另一个单机的两个端点值的坐标时,确定两个单机之间不能发生碰撞,否则需要采取防碰撞操作。
具体的,以位于同一轨道上的单机M1和单机M2为例解释本发明实施例提供的技术方案。
假设单机M1的臂架长度为LM1B,单机M1的配重长度为LM1P,单机M1的行走位置为XM1,单机M1的回转角度为θM1,单机M2的臂架长度为LM2B,单机M2的配重长度为LM2P,单机M2的行走位置为XM2,单机M2的回转角度为θM2,这些数据来源于单机的机械结构和实际位置。同时设单机M1臂架头部在X轴上位置为XM1B,单机M1配重头部在X轴上位置为XM1P,单机M2臂架头部在X轴上位置为XM2B,单机M2配重头部在X轴上位置为XM2P,则根据单机的位置关系和数学公式可得:
XM1B=XM1+LM1B×COSθM1
XM1P=XM1-LM1P×COSθM1
XM2B=XM2+LM2B×COSθM2
XM2P=XM2-LM2P×COSθM2
假设在堆场中,单机M1位于单机M2的东侧,为了保证单机M1与单机M2在任何情况下都不发生碰撞,只需要将单机M1在X轴上的投影和单机M2在X轴上的投影完全隔离开,即没有重叠即可,因此需要同时满足下面4个条件:
XM1B>XM2B
XM1B>XM2P
XM1P>XM2B
XM1P>XM2P
在单机运行过程中,如果上述4个条件同时满足,则单机M1与单机M2不会发生碰撞,如果有1个条件或者多个条件同时不满足,则单机M1与单机M2存在着碰撞风险,此时可以利用此碰撞风险信息,停止单机M1与单机M2的所有动作,以保证单机的安全。
考虑到在实际的运行过程中,由于惯性的存在,单机从停止动作到完全静止,依然会动作一段距离,为解决这个过程中的碰撞风险问题,在单机M1在X轴上的投影和单机M2在X轴上的投影之间增加一个缓冲余量,设此缓冲余量距离为LY,则上述4个需要同时满足的条件需要修改为以下4个条件:
XM1B-XM2B>LY
XM1B-XM2P>LY
XM1P-XM2B>LY
XM1P-XM2P>LY
其中上述缓冲余量LY的大小可以根据实际单机惯性大小和实际需求设置,为保证设备安全,例如可以将LY的大小设置为20米。
本发明上述实施例中的单机的端点值XM1B、XM1P、XM2B和XM2P,都是经过单机的中心的中心线与构成投影图像的边的交点。为了进一步提高精确度,还可以以构成投影图像的四边形的四个顶点作为单机投影图像的端点值。
对位于不同轨道的多个单机来说,只要多个投影图像中构成投影图像的四个线段之间没有交点,就能确定多个投影图像没有重叠点,不可能发生碰撞。
在此基础上,对位于不同轨道的两个相邻单机来说,需要确定第一单机的投影图像中的第一线段和第二线段是否与处于不同轨道的第二单机的投影图像中的第一线段和第二线段互相平行;在第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间不平行时,判断所述第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间是否具有交点;以及所述第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间具有交点时,采取防碰撞操作。其中,所述单机的第一线段与所述第二线段相平行,且所述第一线段和所述第二线段的方向均为所述单机的投影图像中沿臂架至配重的方向,并且为了后期计算,还需要确定与单机投影图像的轮廓对应的第一线段和第二线段的函数表达式。
具体的,以位于不同轨道上的单机M3和单机M4为例解释本发明实施例提供的技术方案。根据单机的机械结构可知,单机M3和单机M4的臂架和配重部分在堆场地面上的投影是一个长方形,单机M3和单机M4沿臂架和配重方向是两条平行的线段,根据平面内线段的相对位置关系可以进行以下判断:
如果单机M3的两条线段和单机M4的两条线段不平行,则这四条线段所在的四条直线必定有四个交点,如果有任意一个交点在这四条线段上,则发生了碰撞,反之如果四个交点都不这四条线段上而在延长线上,则没有发生碰撞。实际运行中,为了保证单机M3和单机M4不发生碰撞,在计算时可以将臂架和配重的长度和宽度都增加一个保护范围;
如果单机M3的两条线段和单机M4的两条线段平行,则这四条线段肯定不会有交点,但是单机M3和单机M4依然有碰撞的风险,这种情况下,可以按照同一轨道上的单机防碰撞的方法,在X轴方向上将单机M3和单机M4完全隔断开。
进一步的,结合直角坐标系和单机的投影图像的具体计算方法如下所示:
①单机M3的两条线段和单机M4的两条线段不平行
设单机M3的臂架长度为LM3B,配重长度为LM3P,臂架中心线到臂架两边的宽度为WM3B(臂架和配重宽度一样),单机M3的行走位置为XM3,回转角度为θM3,单机M4的臂架长度为LM4B,配重长度为LM4P,单机M4的行走位置为XM4,回转角度为θM4,臂架中心线到臂架两边的宽度为WM4B(臂架和配重宽度一样),臂架长度和配重长度增加保护范围L1,臂架宽度增加保护范围W1,则在计算过程中用到的实际增加保护范围的臂架长度和臂架中心线到臂架两边宽度分别为:
LM3B+=LM3B+L1
LM3P+=LM3P+L1
WM3B+=WM3B+W1
LM4B+=LM4B+L1
LM4P+=LM4P+L1
WM4B+=WM4B+W1
设M3所在的轨道BD1中心线在Y轴上的位置为YBD1,M4所在的轨道BQ1中心线在Y轴上的位置为YBQ1,设单机M3臂架中心线头部坐标位置为(XM3B,YM3B),单机M4臂架中心线头部坐标位置为(XM4B,YM4B),则可得:
XM3B=XM3+LM3B+×COSθM3
YM3B=YBD1+LM3B+×SINθM3
XM4B=XM4+LM4B+×COSθM4
YM4B=YBQ1+LM4B+×SINθM4
单机M3臂架中心线与单机M3所在轨道中心线交点坐标为(XM3,YBD1);
单机M4臂架中心线与单机M4所在轨道中心线交点坐标为(XM4,YBQ1)。
根据平面内两点确定一条直线,已知单机M3的臂架中心线头部的坐标(XM3B,YM3B)和单机M3臂架中心线与单机M3所在轨道中心线交点坐标(XM3,YBD1),设单机M3臂架的中心线所在的直线方程为y=kM3x+bM3,则根据直线方程可得:
根据平行直线斜率相等,可设单机M3臂架的两条线段所在的直线方程分别为y=kM3x+bM3_1和y=kM3x+bM3_2(臂架和配重宽度一样,保护范围一样,故臂架和配重在相同的两条直线上),则根据平行直线的距离公式可得:
同理,已知单机M4的臂架中心线头部的坐标(XM4B,YM4B)和单机M4的臂架中心线与轨道中心线交点的坐标(XM4,YBQ1),设单机M4臂架中心线所在的直线方程为y=kM4x+bM4,则根据直线方程可得:
同理,设单机M4臂架的两条线段所在的直线方程分别为y=kM4x+bM4_1和y=kM4x+bM4_2(臂架和配重宽度一样,保护范围一样,故臂架和配重在相同的两条直线上),则根据平行直线的距离公式可得:
设y=kM3x+bM3_1和y=kM4x+bM4_1的交点坐标为(X1,Y1),则根据直线方程可得:
设y=kM3x+bM3_1和y=kM4x+bM4_2的交点坐标为(X2,Y2),则根据直线方程可得:
设y=kM3x+bM3_2和y=kM4x+bM4_1的交点坐标为(X3,Y3),则根据直线方程可得:
设y=kM3x+bM3_2和y=kM4x+bM4_2的交点坐标为(X4,Y4),则根据直线方程可得:
通过上述实施例提供的计算过程,可以得到在单机M3的两条线段和单机M4的两条线段不平行时,单机M3的两条线段所在的直线和单机M4的两条线段所在的直线的四个交点:(X1,Y1),(X2,Y2),(X3,Y3)和(X4,Y4)。在确定四个交点以后,需要执行以下操作以确定这四个交点是这四条线段上还是在这四条线段的延长线上。
设单机M3配重中心线头部坐标位置为(XM3P,YM3P),单机M4配重中心线头部坐标位置为(XM4P,YM4P),则可得:
XM3P=XM3-LM3P+×COSθM3
YM3P=YBD1-LM3P+×SINθM3
XM4P=XM4-LM4P+×COSθM4
YM4P=YBQ1-LM4P+×SINθM4
设单机M3臂架中心线和配重中心线在X轴投影范围为:XM3_min到XM3_max,单机M3臂架中心线和配重中心线在Y轴投影范围为:YM3_min到YM3_max,则可得:
XM3B≥XM3P时:XM3_min=XM3P,XM3_max=XM3B
XM3B<XM3P时:XM3_min=XM3B,XM3_max=XM3P
YM3B≥YM3P时:YM3_min=YM3P,YM3_max=YM3B
YM3B<YM3P时:YM3_min=YM3B,YM3_max=YM3P
同理,设单机M4臂架中心线和配重中心线在X轴投影范围为:XM4_min到XM4_max,单机M4臂架中心线和配重中心线在Y轴投影范围为:YM4_min到YM4_max,则可得:
XM4B≥XM4P时:,XM4_min=XM4P XM4_max=XM4B
XM4B<XM4P时:XM4_min=XM4B,XM4_max=XM4P
YM4B≥YM4P时:YM4_min=YM4P,YM4_max=YM4B
YM4B<YM4P时:YM4_min=YM4B,YM4_max=YM4P
将单机M3的回转角度θM3作绝对值运算得到单机M3回转角度绝对值θM3abs,设单机M3的第一条线段在X轴投影范围为:XM3_1_min到XM3_1_max,在Y轴的投影范围为:YM3_1_min到YM3_1_max,单机M3的第二条线段在X轴投影范围为:XM3_2_min到XM3_2_max,在Y轴的投影范围为:YM3_2_min到YM3_2_max,则可得:
当kM3≥0时,
XM3_1_min=XM3_min-WM3B+×SINθM3abs
XM3_1_max=XM3_max-WM3B+×SINθM3abs
YM3_1_min=YM3_min+WM3B+×COSθM3abs
YM3_1_max=YM3_max+WM3B+×COSθM3abs
XM3_2_min=XM3_min+WM3B+×SINθM3abs
XM3_2_max=XM3_max+WM3B+×SINθM3abs
YM3_2_min=YM3_min-WM3B+×COSθM3abs
YM3_2_max=YM3_max-WM3B+×COSθM3abs
当kM3<0时,
XM3_1_min=XM3_min+WM3B+×SINθM3abs
XM3_1_max=XM3_max+WM3B+×SINθM3abs
YM3_1_min=YM3_min+WM3B+×COSθM3abs
YM3_1_max=YM3_max+WM3B+×COSθM3abs
XM3_2_min=XM3_min-WM3B+×SINθM3abs
XM3_2_max=XM3_max-WM3B+×SINθM3abs
YM3_2_min=YM3_min-WM3B+×COSθM3abs
YM3_2_max=YM3_max-WM3B+×COSθM3abs
同理,将单机M4的回转角度θM4作绝对值运算得到单机M4回转角度绝对值θM4abs,设单机M4的第一条线段在X轴投影范围为:XM4_1_min到XM4_1_max,在Y轴的投影范围为:YM4_1_min到YM4_1_max,单机M4的第二条线段在X轴投影范围为:XM4_2_min到XM4_2_max,在Y轴的投影范围为:YM4_2_min到YM4_2_max,则可得:
当kM4≥0时,
XM4_1_min=XM4_min-WM4B+×SINθM4abs
XM4_1_max=XM4_max-WM4B+×SINθM4abs
YM4_1_min=YM4_min+WM4B+×COSθM4abs
YM4_1_max=YM4_max+WM4B+×COSθM4abs
XM4_2_min=XM4_min+WM4B+×SINθM4abs
XM4_2_max=XM4_max+WM4B+×SINθM4abs
YM4_2_min=YM4_min-WM4B+×COSθM4abs
YM4_2_max=YM4_max-WM4B+×COSθM4abs
当kM4<0时,
XM4_1_min=XM4_min+WM4B+×SINθM4abs
XM4_1_max=XM4_max+WM4B+×SINθM4abs
YM4_1_min=YM4_min+WM4B+×COSθM4abs
YM4_1_max=YM4_max+WM4B+×COSθM4abs
XM4_2_min=XM4_min-WM4B+×SINθM4abs
XM4_2_max=XM4_max-WM4B+×SINθM4abs
YM4_2_min=YM4_min-WM4B+×COSθM4abs
YM4_2_max=YM4_max-WM4B+×COSθM4abs
根据上述计算得到的四个交点坐标和四条线段的范围,可以得到以下内容:
(1)XM3_1_min≤X1≤XM3_1_max,YM3_1_min≤Y1≤YM3_1_max
上面两个条件同时满足时,表示线段交点(X1,Y1)在单机M3的第一条线段上;
XM4_1_min≤X1≤XM4_1_max,YM4_1_min≤Y1≤YM4_1_max
上面两个条件同时满足时,表示线段交点(X1,Y1)在单机M4的第一条线段上;
当交点(X1,Y1)既在单机M3的线段上,又在单机M4的线段上,则说明单机M3和单机M4有碰撞风险。反之则单机M3与单机M4距离在碰撞区域之外。
(2)XM3_1_min≤X2≤XM3_1_max,YM3_1_min≤Y2≤YM3_1_max
上面两个条件同时满足时,表示线段交点(X2,Y2)在单机M3的第一条线段上;
XM4_2_min≤X2≤XM4_2_max,YM4_2_min≤Y2≤YM4_2_max
上面两个条件同时满足时,表示线段交点(X2,Y2)在单机M4的第二条线段上;
当交点(X2,Y2)既在单机M3的线段上,又在单机M4的线段上,则说明单机M3和单机M4有碰撞风险。反之则单机M3与单机M4距离在碰撞区域之外。
(3)XM3_2_min≤X3≤XM3_2_max,YM3_2_min≤Y3≤YM3_2_max
上面两个条件同时满足时,表示线段交点(X3,Y3)在单机M3的第二条线段上;
XM4_1_min≤X3≤XM4_1_max,YM4_1_min≤Y3≤YM4_1_max
上面两个条件同时满足时,表示线段交点(X3,Y3)在单机M4的第一条线段上;
当交点(X3,Y3)既在单机M3的线段上,又在单机M4的线段上,则说明单机M3和单机M4有碰撞风险。反之则单机M3与单机M4距离在碰撞区域之外。
(4)XM3_2_min≤X4≤XM3_2_max,YM3_2_min≤Y4≤YM3_2_max
上面两个条件同时满足时,表示线段交点(X4,Y4)在单机M3的第二条线段上;
XM4_2_min≤X4≤XM4_2_max,YM4_2_min≤Y4≤YM4_2_max
上面两个条件同时满足时,表示线段交点(X4,Y4)在单机M4的第二条线段上;
当交点(X4,Y4)既在单机M3的线段上,又在单机M4的线段上,则说明单机M3和单机M4有碰撞风险。反之则单机M3与单机M4距离在碰撞区域之外。
以上四种情况,只要出现一个交点既在单机M3的线段上,又在单机M4的线段上,则单机M3与单机M4存在着碰撞风险,此时可以利用获得的碰撞风险信息,停止单机M3与单机M4的所有动作,以保证单机的安全。
在实际测试运行中,由于堆场尺寸和单机结构大小,臂架和配重的长度和宽度增加保护范围之后,如果一台单机在较大回转角度(大于70°)作业,此时另一台单机在归零状态从旁边行走经过时,根据上面的计算,两台单机会出防碰撞报警,并停止两台单机的动作,这种情况如果归零状态的单机不做回转,则两台单机肯定不会发生碰撞,所以停止动作会对单机正常作业造成一定的影响。根据实际作业需求,可以增加以下要求:当一台单机处于归零状态(回转角度在±3°以内)时,屏蔽其与邻近单机的防碰撞信息,不会造成单机停止动作,只有当单机都不在归零状态时,才可以根据防碰撞信息确定是否需要停止单机动作。
②单机M3的两条线段和单机M4的两条线段平行
当θM3=θM4或θM3abs+θM4abs=180°时,表示单机M3的两条线段和单机M4的两条线段平,这种情况下单机M3的两条线段所在的直线和单机M4的两条线段所在的直线没有交点,无法根据有交点的情况判断两台单机是否有防碰风险,因此可以按照同线单机防碰撞的方法,在X轴方向上将单机M3和单机M4完全隔断开即可,具体计算方法如下:
-LY≤XM3_min-XM4_min≤LY
当上面这个条件被满足时,表示单机M3和单机M4在X轴方向上距离小于缓冲余量,存在碰撞风险,此时可以根据碰撞风险信息,停止单机M3与单机M4的所有动作,以保证单机的安全。
在实际运行过程中,因为单机编码器精度问题,几乎不会出现刚好θM3=θM4或θM3abs+θM4abs=180°的情况,因此在计算中为平行的条件设置一个范围,即-2°≤θM3-θM4≤2°或178°≤θM3abs+θM4abs≤180°都可以认为认为是平行。可选的,角度范围不限于上述举例内容,用户可以根据设备情况和实际需求自行设定合理的角度范围以确定单机之间是否平行。
本发明实施例提供的技术方案,可以根据单机的行走位置信息和回转角度信息确定对场内自动运行的单机之间是否可能会发生碰撞,并在单机之间发生碰撞之前采取防碰撞操作以保护单机安全,有效保护单机远程自动作业和全天候无人值守时的单机设备安全,节省了班组人员的人工成本,降低了班组人员的工作压力,还能够有效提供生产效率。
本发明实施例提供的技术方案,针对位于同轨道单机和位于不同轨道单机设置了不同的判断条件,以适用于堆场内的单机之间的多种位置关系。并且将堆场作为一个直角坐标系,将单机的实时位置化作直角坐标系中的电和线,将空间中的单机防碰撞问题简化为平面中的点线问题,能够有效简化防碰撞方法的计算量。
图3是本发明实施例提供的单机防碰撞的系统的结构示意图。如图3所示,所述单机防碰撞的系统包括控制模块310和多个可编程逻辑控制器320。其中,所述多个可编程逻辑控制器320分别位于堆场内的各个单机上,用于采集单机的行走位置信息和回转角度信息,并将采集的行走位置信息和回转角度信息发送至所述控制模块310,所述控制模块310则用于执行上述实施例中任一项所述的单机防碰撞的方法。
进一步的,可以将控制模块设置在集控室内,并且还可以增设操作界面和“防碰撞旁路”操作按钮。在两台单机之间触发防碰撞条件时,控制模块会停止两台单机的动作,并发出报警信息,以提醒操作员防碰撞条件已触发,此时操作员可以通过视频监控系统确认现场情况后,触发“防碰撞旁路”操作按钮,以使防碰撞保护功能暂时处于旁路模式,旁路后可以手动操作控制单机,将两台靠近的单机分开,分开后的单机不再满足防碰撞触发条件,此时的“防碰撞旁路”信号会自动复位,防止误动作导致两台单机发生碰撞。
本发明实施例提供的单机防碰撞的系统的具体工作原理及益处与上述本发明实施例提供的单机防碰撞的方法的具体工作原理及益处相似,这里将不再赘述。
以上结合附图详细描述了本发明实施例的可选实施方式,但是,本发明实施例并不限于上述实施方式中的具体细节,在本发明实施例的技术构思范围内,可以对本发明实施例的技术方案进行多种简单变型,这些简单变型均属于本发明实施例的保护范围。
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本发明实施例对各种可能的组合方式不再另行说明。
本领域技术人员可以理解实现上述实施例方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,该程序存储在一个存储介质中,包括若干指令用以使得单片机、芯片或处理器(processor)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
此外,本发明实施例的各种不同的实施方式之间也可以进行任意组合,只要其不违背本发明实施例的思想,其同样应当视为本发明实施例所公开的内容。
Claims (10)
1.一种单机防碰撞的方法,其特征在于,所述方法包括:
获取堆场内全部单机的行走位置信息和回转角度信息;
根据单机的行走位置信息和回转角度信息确定所述单机在堆场地面的投影图像;以及
判断不同单机的投影图像之间是否有重叠点,在所述不同单机的投影图像之间有重叠点时,采取防碰撞操作。
2.根据权利要求1所述的方法,其特征在于,所述方法还包括:
根据单机的行走位置信息和回转角度信息确定所述单机在堆场地面的投影图像以后,在所述投影图像中增加缓冲余量以生成具有缓冲余量的投影图像;
判断不同单机的具有缓冲余量的投影图像之间是否有重叠点;以及
在不同单机的具有缓冲余量的投影图像之间有重叠点时,采取防碰撞操作。
3.根据权利要求2所述的方法,其特征在于,所述在投影图像中增加缓冲余量以生成具有缓冲余量的投影图像包括:
将单机的臂架和配重的长度和宽度都增加预设距离后得到的投影图像作为所述具有缓冲余量的投影图像。
4.根据权利要求1所述的方法,其特征在于,所述方法还包括:
确定回转角度处于预设角度范围之内的单机不会与周围其它的单机发生碰撞。
5.根据权利要求1所述的方法,其特征在于,通过以下方式根据单机的行走位置信息和回转角度信息确定所述单机在堆场地面的投影图像:
以所述堆场地面为对象建立平面直角坐标系;
根据单机的行走位置、臂架长度、配重长度和回转角度,确定所述单机的投影图像在所述平面直角坐标系中的函数表达式。
6.根据权利要求5所述的方法,其特征在于,所述方法还包括:
在多个单机处于所述堆场内的同一轨道时,确定单机的投影图像在坐标轴上的投影的两个端点值的坐标;以及
在某一单机的两个端点值的坐标值全部大于另一单机的两个端点值的坐标值时,确定这两个单机之间不能发生碰撞,否则采取防碰撞操作。
7.根据权利要求5所述的方法,其特征在于,所述方法还包括:
在多个单机处于堆场内的不同轨道时,确定与单机的投影图像的轮廓对应的第一线段和第二线段的函数表达式,所述第一线段与所述第二线段相平行,且所述第一线段和所述第二线段的方向为所述单机的投影图像中沿臂架至配重的方向;
确定第一单机的投影图像中的第一线段和第二线段是否与处于不同轨道的第二单机的投影图像中的第一线段和第二线段互相平行;
在第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间不平行时,判断所述第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间是否具有交点;以及
所述第一单机的投影图像中的第一线段和第二线段与所述第二单机的投影图像中的第一线段和第二线段之间具有交点时,采取防碰撞操作。
8.根据权利要求7所述的方法,其特征在于,所述方法还包括:
在第一单机的投影图像中的第一线段和第二线段与处于不同轨道的第二单机的投影图像中的第一线段和第二线段之间相互平行时,获取所述第一单机与所述第二单机的投影图像在坐标轴上的投影的两个端点值的坐标;以及
在所述第一单机的两个端点值的坐标值全部大于或小于所述第二单机的两个端点值的坐标值时,确定所述第一单机与所述第二单机之间不能发生碰撞,否则采取防碰撞操作。
9.根据权利要求7所述的方法,其特征在于,在两个单机的回转角度之和为预设范围时,确定所述两个单机的投影图像中的第一线段之间和第二线段之间处于相互平行的状态。
10.一种单机防碰撞的系统,其特征在于,所述系统包括控制模块和位于单机的可编程逻辑控制器,
所述可编程逻辑控制器用于采集单机的行走位置信息和回转角度信息,并将所述行走位置信息和回转角度信息发送至所述控制模块;
控制模块,用于执行根据权利要求1-9中任一项所述的单机防碰撞的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910498462.3A CN110221574B (zh) | 2019-06-10 | 2019-06-10 | 单机防碰撞的方法和系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910498462.3A CN110221574B (zh) | 2019-06-10 | 2019-06-10 | 单机防碰撞的方法和系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110221574A true CN110221574A (zh) | 2019-09-10 |
CN110221574B CN110221574B (zh) | 2021-05-11 |
Family
ID=67816218
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910498462.3A Active CN110221574B (zh) | 2019-06-10 | 2019-06-10 | 单机防碰撞的方法和系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110221574B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110660272A (zh) * | 2019-09-27 | 2020-01-07 | 南京莱斯网信技术研究院有限公司 | 一种适用于内河水上船舶碰撞预警检测的方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS57126304A (en) * | 1981-01-26 | 1982-08-06 | Hitachi Ltd | Fork starting device of stacker crane |
CN201485191U (zh) * | 2009-03-26 | 2010-05-26 | 西安聚核电子有限公司 | 一种塔机二维行程限位装置 |
CN103738739A (zh) * | 2014-01-08 | 2014-04-23 | 中国神华能源股份有限公司 | 用于防止堆/取料机彼此碰撞的方法及系统 |
CN103964155A (zh) * | 2014-05-19 | 2014-08-06 | 泰富国际工程有限公司 | 一种斗轮堆取料机防撞控制方法 |
CN104386504A (zh) * | 2014-11-06 | 2015-03-04 | 泰富国际工程有限公司 | 一种悬臂堆取料机防撞控制方法 |
CN105512377A (zh) * | 2015-11-30 | 2016-04-20 | 腾讯科技(深圳)有限公司 | 实时虚拟场景中圆柱碰撞体与凸体碰撞探测的方法和系统 |
CN105668258A (zh) * | 2015-12-29 | 2016-06-15 | 中国神华能源股份有限公司 | 取料机防碰撞的方法和系统 |
CN109052201A (zh) * | 2018-10-17 | 2018-12-21 | 中国水利水电第七工程局有限公司 | 一种起重设备防碰撞预警系统及其方法 |
-
2019
- 2019-06-10 CN CN201910498462.3A patent/CN110221574B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS57126304A (en) * | 1981-01-26 | 1982-08-06 | Hitachi Ltd | Fork starting device of stacker crane |
CN201485191U (zh) * | 2009-03-26 | 2010-05-26 | 西安聚核电子有限公司 | 一种塔机二维行程限位装置 |
CN103738739A (zh) * | 2014-01-08 | 2014-04-23 | 中国神华能源股份有限公司 | 用于防止堆/取料机彼此碰撞的方法及系统 |
CN103964155A (zh) * | 2014-05-19 | 2014-08-06 | 泰富国际工程有限公司 | 一种斗轮堆取料机防撞控制方法 |
CN104386504A (zh) * | 2014-11-06 | 2015-03-04 | 泰富国际工程有限公司 | 一种悬臂堆取料机防撞控制方法 |
CN105512377A (zh) * | 2015-11-30 | 2016-04-20 | 腾讯科技(深圳)有限公司 | 实时虚拟场景中圆柱碰撞体与凸体碰撞探测的方法和系统 |
CN105668258A (zh) * | 2015-12-29 | 2016-06-15 | 中国神华能源股份有限公司 | 取料机防碰撞的方法和系统 |
CN109052201A (zh) * | 2018-10-17 | 2018-12-21 | 中国水利水电第七工程局有限公司 | 一种起重设备防碰撞预警系统及其方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110660272A (zh) * | 2019-09-27 | 2020-01-07 | 南京莱斯网信技术研究院有限公司 | 一种适用于内河水上船舶碰撞预警检测的方法 |
WO2021057049A1 (zh) * | 2019-09-27 | 2021-04-01 | 南京莱斯网信技术研究院有限公司 | 一种适用于内河水上船舶碰撞预警检测的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110221574B (zh) | 2021-05-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104460666B (zh) | 一种基于距离矢量的机器人自主避障移动控制方法 | |
EP1362336B1 (en) | Anti-collision protection system | |
CN109650089B (zh) | 一种堆场堆取料机与物料堆的防碰撞方法 | |
CN110609550B (zh) | 一种机器人防止碰撞充电座的方法 | |
TWI680364B (zh) | 用於教練式驅動多機器人合作運作系統之教練裝置及其合作運作控制方法 | |
CN111924460A (zh) | 一种码垛控制方法及系统 | |
CN106647810A (zh) | 一种基于负比例导引的无人机自动避撞方法 | |
CN103964155B (zh) | 一种斗轮堆取料机防撞控制方法 | |
CN103738739A (zh) | 用于防止堆/取料机彼此碰撞的方法及系统 | |
CN104386504B (zh) | 一种悬臂堆取料机防撞控制方法 | |
CN107539887A (zh) | 建筑施工塔吊机群防碰撞预警辅助系统 | |
CN110221574A (zh) | 单机防碰撞的方法和系统 | |
CN105712055A (zh) | 一种基于gnss的堆取料机位置检测及防碰撞系统 | |
Jobes et al. | Evaluation of an advanced proximity detection system for continuous mining machines | |
CN110432832A (zh) | 机器人运动轨迹的调整方法、装置及机器人 | |
CN115872248A (zh) | 机器人进梯的控制方法、装置、系统、设备及存储介质 | |
CN104609207B (zh) | 一种料场堆取料机防撞控制方法 | |
US20220176560A1 (en) | Control system, control method, and control unit | |
CN105690395B (zh) | 工业机器人及其控制方法 | |
CN103922225B (zh) | 塔机安全运行控制方法 | |
CN110356862A (zh) | 一种基于gps定位的堆取料机防碰撞方法及系统 | |
CN113204733B (zh) | 一种同轨道斗轮堆取料机防碰撞方法 | |
CN204575133U (zh) | 视觉智能采集定位系统 | |
CN115847412B (zh) | 一种基于分离框的异轨堆、取料机防碰撞运动规划方法 | |
JP3915049B2 (ja) | 消火設備 |
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 |