一种两台同轨道自动化装船机综合防碰撞方法技术

本发明专利技术公开了一种两台同轨道自动化装船机综合防碰撞方法，包括以下步骤：（1）两台装船机PLC分别计算各自的大车行走距离、变幅角度以及回转角度并将计算结果发送至中控室CPU；（2）计算单台装船机后部配重与尾车结构的防碰撞结果，并控制其动作；（3）计算单台装船机前部卸料斗与码头和走道的防碰撞一结果，并控制其动作；（4）计算单台装船机前部卸料斗与码头和走道的防碰撞二结果，并控制其动作；（5）计算单台装船机臂架与尾车结构的防碰撞结果；（6）计算两台装船机之间的防碰撞结果，两台装船机根据接收到的防碰撞结果来控制其动作。本发明专利技术克服了安全防撞防护的巨大挑战，实现了装船机的全自动无人化操作模式。全自动无人化操作模式。全自动无人化操作模式。

【技术实现步骤摘要】
一种两台同轨道自动化装船机综合防碰撞方法


[0001]本专利技术涉及一种综合防碰撞方法，具体涉及一种两台同轨道自动化装船机综合防碰撞方法。

技术介绍

[0002]目前在同轨道上一般会有两台装船机进行作业，两台装船机之间存在碰撞危险，尤其是当前各企业都想要实现装船机的全自动无人化操作，这就导致防碰撞措施的可靠性成为了重中之重。因此，以上问题亟需解决。

技术实现思路

[0003]本专利技术要解决的技术问题是提供一种两台同轨道自动化装船机综合防碰撞方法，克服了安全防撞防护的巨大挑战，实现了装船机的全自动无人化操作模式。
[0004]为解决上述技术问题，本专利技术采取如下技术方案：本专利技术的一种两台同轨道自动化装船机综合防碰撞方法，其创新点在于包括以下步骤：
[0005](1)两台装船机的PLC控制单元分别计算各自的大车行走距离、变幅角度以及回转角度，并将计算结果发送至中控室CPU；
[0006](2)两台装船机的PLC控制单元分别根据数学模型设定输入输出值，计算单台装船机后部配重与尾车结构的防碰撞结果，并控制其动作；
[0007](3)两台装船机的PLC控制单元分别根据数学模型设定输入输出值，计算单台装船机前部卸料斗与码头和走道的防碰撞一结果，并控制其动作；
[0008](4)两台装船机的PLC控制单元分别根据数学模型设定输入输出值，计算单台装船机前部卸料斗与码头和走道的防碰撞二结果，并控制其动作；
[0009](5)两台装船机的PLC控制单元分别根据数学模型设定输入输出值，计算单台装船机臂架与尾车结构的防碰撞结果；
[0010](6)中控室CPU根据数学模型设定输入输出值，计算两台装船机之间的防碰撞结果，并将防碰撞结果发送至两台装船机，两台装船机根据接收到的防碰撞结果来控制其动作。
[0011]优选的，在上述步骤(1)中，大车行走距离是根据行走编码器与跟随轮的机械齿轮传动原理来确定，且其计算公式为：
[0012][0013]式中，L
t
为大车行走距离，单位为m；p
i
为圆周率；D为跟随轮直径；r
t
为行走编码器单圈脉冲数；V
0t
为行走编码器校准原始值；V
at
为行走编码器实时数据。
[0014]优选的，在上述步骤(1)中，变幅编码器安装在臂架铰点，并根据此位置角度变化与变幅编码器数据变化的关系来确定变幅角度，其计算公式为：
[0015][0016]式中，A
b
为变幅编码器变化总角度；r
b
为变幅编码器单圈脉冲数；V
0b
为变幅编码器校准原始值；V
ab
为变幅编码器实时数据。
[0017]优选的，在上述步骤(1)中，回转角度根据机械齿轮传动原理来确定，且其计算公式为：
[0018][0019]式中，A
t
为回转编码器变化总角度；r
s
为回转编码器单圈脉冲数；m
b
为大齿圈齿数；m
s
为小齿圈齿数；V
0s
为回转编码器校准原始值；V
as
为回转编码器实时数据；
[0020]再通过逻辑判断计算回转实时角度A
a
，且逻辑判断方法为：
[0021]a)如果0
°
≤A
t
≤360
°
，则A
a
＝A
t
；
[0022]b)如果
‑
360
°
≤A
t
<0
°
，则A
a
＝A
t
+360；
[0023]c)如果A
t
<
‑
360
°
或者A
t
>360，则A
a
＝A
t mod
±
360。
[0024]优选的，将所需控制的条件扩大至普遍模型，列矩阵如下：
[0025]条件1A1条件2A2条件3A3……
条件iA
i
……
条件mA
m
数值1A
11
数值1A
21
数值1A
31
……
数值1A
i1
……
数值1A
m1
数值2A
12
数值2A
22
数值2A
32
……
数值2A
i2
……
数值2A
m2
数值3A
13
数值3A
23
数值3A
33
……
数值3A
i3
……
数值3A
m3
……………………………………
数值jA
1j
数值jA
2j
数值jA
2j
……
数值jA
ij
……
数值jA
mj
……………………………………
数值nA
1n
数值nA
2n
数值nA
3n
……
数值nA
in
……
数值nA
mn
[0026]针对逻辑特点来建立数学模型，设每个条件的控制因子为：
[0027][0028]上述公式(4)应满足条件
[0029]其中，i为条件序列号；j为单个条件对应值序列号；m为最大条件数目；n为单个条件最多数值区间序号；S
i
为条件是否需要参与考虑的系数。
[0030]优选的，在上述步骤(2)中，单台装船机后部配重与尾车结构的防碰撞逻辑为需同时满足以下条件：
[0031](2.1)当变幅角度大于0
°
的条件不满足时，回转动作不允许在
‑
30
°
和+30
°
之间工作；
[0032](2.2)当回转角度在
‑
30
°
和+30
°
之间时，变幅角度不允许小于0
°
；
[0033](2.3)选中自动模式、手动模式、就地模式中任一种模式才可以进行动作。
[0034]优选的，在上述步骤(3)中，单台装船机前部卸料斗与码头和走道的防碰撞一逻辑为需同时满足以下条件：
[0035](3.1)当回转角度在
‑
35
°
和
‑
30
°
之间或者+30
°
和+35
°
时，变幅的最小动作角度为
‑4°...

【技术保护点】

【技术特征摘要】
1.一种两台同轨道自动化装船机综合防碰撞方法，其特征在于包括以下步骤：(1)两台装船机的PLC控制单元分别计算各自的大车行走距离、变幅角度以及回转角度，并将计算结果发送至中控室CPU；(2)两台装船机的PLC控制单元分别根据数学模型设定输入输出值，计算单台装船机后部配重与尾车结构的防碰撞结果，并控制其动作；(3)两台装船机的PLC控制单元分别根据数学模型设定输入输出值，计算单台装船机前部卸料斗与码头和走道的防碰撞一结果，并控制其动作；(4)两台装船机的PLC控制单元分别根据数学模型设定输入输出值，计算单台装船机前部卸料斗与码头和走道的防碰撞二结果，并控制其动作；(5)两台装船机的PLC控制单元分别根据数学模型设定输入输出值，计算单台装船机臂架与尾车结构的防碰撞结果；(6)中控室CPU根据数学模型设定输入输出值，计算两台装船机之间的防碰撞结果，并将防碰撞结果发送至两台装船机，两台装船机根据接收到的防碰撞结果来控制其动作。2.根据权利要求1所述的一种两台同轨道自动化装船机综合防碰撞方法，其特征在于：在上述步骤(1)中，大车行走距离是根据行走编码器与跟随轮的机械齿轮传动原理来确定，且其计算公式为：式中，L
t
为大车行走距离，单位为m；p
i
为圆周率；D为跟随轮直径；r
t
为行走编码器单圈脉冲数；V
0t
为行走编码器校准原始值；V
at
为行走编码器实时数据。3.根据权利要求1所述的一种两台同轨道自动化装船机综合防碰撞方法，其特征在于：在上述步骤(1)中，变幅编码器安装在臂架铰点，并根据此位置角度变化与变幅编码器数据变化的关系来确定变幅角度，其计算公式为：式中，A
b
为变幅编码器变化总角度；r
b
为变幅编码器单圈脉冲数；V
0b
为变幅编码器校准原始值；V
ab
为变幅编码器实时数据。4.根据权利要求1所述的一种两台同轨道自动化装船机综合防碰撞方法，其特征在于：在上述步骤(1)中，回转角度根据机械齿轮传动原理来确定，且其计算公式为：式中，A
t
为回转编码器变化总角度；r
s
为回转编码器单圈脉冲数；m
b
为大齿圈齿数；m
s
为小齿圈齿数；V
0s
为回转编码器校准原始值；V
as
为回转编码器实时数据；再通过逻辑判断计算回转实时角度A
a
，且逻辑判断方法为：a)如果0
°
≤A
t
≤360
°
，则A
a
＝A
t
；b)如果
‑
360
°
≤A
t
<0
°
，则A
a
＝A
t
+360；c)如果A
t
<
‑
360
°
或者A
t
>360，则A
a
＝A
t mod
±
360。5.根据权利要求1所述的一种两台同轨道自动化装船机综合防碰撞方法，其特征在于：将所需控制的条件扩大至普遍模型，列矩阵如下：
针对逻辑特点来建立数学模型，设每个条件的控制因子为：上述公式(4)应满足条件其中，i为条件序列号；j为单个条件对应值序列号；m为最大条件数目；n为单个条件最多数值区间序号；S
i
为条件是否需要参与考虑的系数。6.根据权利要求5所述的一种两台同轨道自动化装船机综合防碰撞方法，其特征在于：在上述步骤(2)中，单台装船机后部配重与尾车结构的防碰撞逻辑为需同时满足以下条件：(2.1)当变幅角度大于0
°
的条件不满足时，回转动作不允许在
‑
30
°
和+30
°
之间工作；(2.2)当回转角度在
‑
30
°
和+30
°
之间时，变幅角度不允许小于0
°
；(2.3)选中自动模式、手动模式、就地模式中任一种模式才可以进行动作。7.根据权利要求5所述的一种两台同轨道自动化装船机综合防碰撞方法，其特征在于：在上述步骤(3)中，单台装船机前部卸料斗与码头和走道的防碰撞一逻辑为需同时满足以下条件：(3.1)当回转角度在
‑
35
°
和
‑
30
°
之间或者+30
°
和+35
°
时，变幅的最小动作角度为
‑4°
，伸缩溜筒必须保证在最高位置，臂架伸缩最小位置为6m；(3.2)当变幅角度大于
‑4°
、伸缩溜筒必须保证在最高位置、以及臂架伸缩位置大于6m这三个条件没有同时满足时，回转不允许在
‑
35
°
和
‑
30
°
之间或者+30
°
和+35
°
工作；(3.3)当回转角度在
‑
30
°
和
‑
26

【专利技术属性】
技术研发人员：金建，崔益华，顾建峰，任进勇，王建，
申请(专利权)人：南通润邦重机有限公司，
类型：发明
国别省市：