CN104122893B - 一种用于智能接运装置的控制系统及控制方法 - Google Patents
一种用于智能接运装置的控制系统及控制方法 Download PDFInfo
- Publication number
- CN104122893B CN104122893B CN201410333289.9A CN201410333289A CN104122893B CN 104122893 B CN104122893 B CN 104122893B CN 201410333289 A CN201410333289 A CN 201410333289A CN 104122893 B CN104122893 B CN 104122893B
- Authority
- CN
- China
- Prior art keywords
- layback
- jacking
- fault
- value
- alarm unit
- 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.)
- Active
Links
Landscapes
- Emergency Alarm Devices (AREA)
Abstract
本发明公开了一种用于智能接运装置的控制系统,由运动控制单元、状态检测单元、报警单元和通信单元组成;同时公开了利用该系统进行集装箱接运装置控制的方法,该方法将智能化码头的AGV卸载和装载集装箱的运输和存放过程分离开来,有效解决了智能化码头ARMG和AGV之间的耦合问题;在控制系统中采用同一套超声波测距传感器,既可测量接运装置的顶升位置又可测量接运装置的侧拉位置,这使得大大简化了接运装置的结构;同时超声波测距采用非接触式测距,延长了传感器的使用寿命,且检测精度高;本发明大大提高了智能化码头AGV平面运输工作效率和装卸生产率,同时也有效减少了智能化码头平面运输需要配置的AGV的数量。
Description
技术领域
本发明涉及一种控制系统及方法,尤其涉及一种专用于智能化码头平面运输集装箱接运装置的控制系统及控制方法。
背景技术
新一代大型智能化集装箱码头可实现无人值守的全自动化集装箱装卸运输,可极大提高集装箱港口的装卸运输效率;在集装箱装卸运输过程中,码头前沿的岸边装卸桥(QC,Quay Crane)与堆场的全自动轨道吊(ARMG,Automated Rail Mounted Gantry crane)之间的集装箱平面运输任务主要由无人自动导航运载车(AGV,Automated GuidedVehicle)完成;
为了提高AGV和ARMG的运输效率,减少其等待时间,AGV与ARMG之间的集装箱运输作业需要一种辅助接运装置(接运装置);即卸箱过程中,QC将船舶上的集装箱接卸到AGV上,由AGV转运到堆场既定位置后,将集装箱转移到接运装置上,然后ARMG再从接运装置上提取集装箱后堆放到给定堆垛上;反过来,装箱过程中,ARMG从给定堆垛上提取集装箱后,先堆放到接运装置上,再由AGV从接运装置上取走集装箱并拖运到码头前沿的指定QC位置下,由QC从AGV上抓取集装箱装船;通过这种辅助接运装置的集装箱平面运输接运过程,将显著减少AGV和ARMG的等待时间,显著提高AGV和ARMG的运输效率;
为使该新型接运装置的动作,我们研究了一种专门针对该接运装置的控制系统;显著地提高了AGV和ARMG的运输效率。
发明内容
本发明为了提高AGV和ARMG的运输效率,我们针对该运输过程使用的接运装置提供了一种能够有效地控制接运装置动作的控制系统及方法,该方法操作简单,控制过程智能化,能够有效地实现接运装置的控制,提高AGV和ARMG的运输效率;
为实现上述目的,本发明采取的技术方案是:
一种用于智能接运装置的控制系统包括与液压系统相连的运动控制单元、与接运装置相连的状态检测单元、报警单元、与中央控制系统相连的通信单元;通信单元分别与运动控制单元、报警单元连接;所述运动控制单元与状态检测单元连接;所述报警单元与检测单元连接;
本发明利用上述控制系统进行接运装置控制的方法,具体的控制方法如下:
步骤一,中央控制系统监控到集装箱拖运装置进入接运装置的设定范围内后,向接运装置控制系统发出侧拉控制命令lR,同时发出相关参数的设置命令,即侧拉限位值设定命令lm、侧拉不平衡故障阀值设定命令εl和侧拉限位故障阀值设定命令El;
步骤二、接运装置控制系统中的通信单元通过无线网络接收侧拉控制命令lR及相关参数设定命令lm、εl和El后,分别向运动控制单元、报警单元发出侧拉控制命令lR、参数设定命令lm、εl和El,报警单元接收参数设定命令后,对相关参数进行设定;运动控制单元接收侧拉控制命令后,向接运装置的左右两侧支架上的侧拉油缸发出侧拉信号,形成侧拉回路,通过油缸控制左右两个支架向两侧实现侧拉,当侧拉到达设定的限位位置后,侧拉完成;
步骤三、侧拉完成后,集装箱拖运装置进入侧拉范围后,运动控制单元侧拉回路切断,侧拉归位;
步骤四、待侧拉归位完成后,需要将集装箱向上顶起,运至装箱位置,此时,中央控制系统向接运装置控制系统发出顶升控制命令hR,同时发出顶升相关参数设定命令,即顶升限位值设定命令hm、顶升故障阀值设定命令Eh、顶升不平衡故障阀值设定命令εh;
步骤五、接运装置控制系统中的通信单元通过无线网络接收顶升控制命令hR及相关参数设定命令hm、εh和Eh后,分别向运动控制单元、报警单元发出顶升控制命令hR和相关参数设定命令hm、εh和Eh,报警单元接收参数设定命令后,对相关参数进行设定;运动控制单元接收顶升控制命令后,向接运装置的左右两侧支架上的顶升油缸发出顶升信号,形成顶升回路,通过油缸控制左右两个支架向上方实现顶升,当顶升到达设定的限位位置后,顶升完成;
步骤六、待顶升完成后,顶升控制回路切断,顶升归位,顶升归位完成后,即完成一次接运过程;
进一步的,在步骤二,侧拉控制过程的具体步骤如下:
步骤1,通信单元通过无线网络接收中央控制器发出的侧拉控制命令lR,并将该侧拉控制命令lR发送给运动控制单元;同时,通信单元接收侧拉限位值设定命令lm、侧拉不平衡故障阀值设定命令εl和侧拉限位故障阀值设定命令El,将这些命令发送至报警单元进行参数设定;
步骤2,运动控制单元接收侧拉控制命令lR,其内部的侧拉控制逻辑开关闭合,形成控制回路;此时侧拉控制命令lR经过侧拉控制逻辑开关分别输送到左侧侧拉信号比较器、右侧侧拉信号比较器,同时,状态检测单元通过左侧超声波测距传感器、右侧超声波测距传感器分别检测接运装置左侧支架、右侧支架侧拉状态,得到左侧支架的侧拉位置高度值h1和右侧支架的侧拉位置高度值h2;左侧拉位置高度值h1和右侧拉位置高度值h2分别被输送到状态检测单元中的侧拉距离运算器,得出左侧支架、右侧支架的侧拉距离值,其中左侧支架的侧拉距离值为l1,右侧支架的侧拉距离值为l2,左侧侧拉信号比较器将侧拉控制命令lR与左侧支架的侧拉距离值l1进行比较得到左侧支架的侧拉控制量Δv1,右侧侧拉信号比较器将侧拉控制命令lR与右侧支架的侧拉距离值l2进行比较得到右侧支架的侧拉控制量Δv2;运动控制单元通过侧拉控制量Δv1和Δv2分别控制接运装置左右两侧的侧拉油缸,从而控制控制接运左侧支架和右侧支架的侧拉运动;直到侧拉位置到达控制命令要到达到的位置lR位置;H为左侧支架和右侧支架的基本高度;
左侧支架的侧拉距离长度值l1和右侧支架的侧拉距离长度值l2的计算公式如下:
左侧拉控制量Δv1和右侧拉控制量Δv2的计算公式如下:
lR-l1=Δv1 公式(3)
lR-l2=Δv2 公式(4)
当控制量Δv1=0和Δv2=0时,表示侧拉已经到达所要侧拉的位置,此时停止侧拉运动;
步骤3,在接运装置的左侧支架和右侧支架侧拉的过程中,状态检测单元实时进行左侧支架的侧拉位置高度值h1和右侧支架的侧拉位置高度值h2的检测,经过内部的侧拉距离运算器计算得到左侧支架、右侧支架的侧拉距离值l1和l2,并对侧拉距离值l1、l2进行分析比较,判断侧拉是否正常;并向报警单元发出告警信号,报警单元接收报警信号后发出报警,具体步骤如下:
(1)信号检测:经过侧拉距离运算器计算后的侧拉距离值l1、l2分别被输送给第四比较器、第五比较器和第六比较器;
(2)信号比较分析:
第四比较器接收左侧侧拉距离值l1和右侧侧拉距离值l2,将左侧侧拉距离值l1和右侧侧拉距离值l2进行比较产生左右两侧侧拉运动的差值Δl,并将该差值Δh发送至侧拉不平衡故障判别器进行分析;
Δl的计算公式为:
l1-l2=Δl 公式(5)
与此同时,第五比较器将右侧侧拉距离值l2与侧拉限位值lm进行比较,产生右侧支架侧拉与限位值之间的差值Δl2m,并将该差值Δl2m发送至右侧侧拉限位故障判别器进行分析;
Δl2m的计算公式为:
l2-lm=Δl2m 公式(6)
与此同时,第六比较器将左侧侧拉距离值l1与侧拉限位值lm进行比较,产生右侧支架侧拉与限位值之间的差值Δl1m,并将该差值Δl1m发送至左侧侧拉限位故障判别器进行分析;
Δl1m的计算公式为:
l1-lm=Δl1m 公式(7)
(3)故障判断及报警:
侧拉不平衡故障判别器将差值Δl与设定的侧拉不平衡故障阀值εl进行比较后,输出故障信号判断信号的逻辑值SC,并将该逻辑值SC输送给报警单元中的侧拉不平衡报警单元;根据判断,若|Δl|<εl时,侧拉不平衡故障判别器输出逻辑值SC=0,则表示该侧拉过程没有超出侧拉不平衡故障阀值εl,没有发生不平衡故障,此时侧拉不平衡报警单元不发出报警信号,报警单元不发出告警;若|Δl|≥εl时,侧拉不平衡故障判别器输出逻辑值SC=1,则表示侧拉过程超过了侧拉不平衡故障阀值εl,发生了不平衡故障;此时侧拉不平衡报警单元发出报警信号,报警单元中侧拉不平衡报警单元发出报警;同时,侧拉逻辑加法器接收该报警逻辑值SC,产生故障逻辑信号SL,此时SL=1,同时输出给运动控制单元中的侧拉控制逻辑开关及报警单元中侧拉故障报警单元,并控制侧拉控制逻辑开关断开,切断侧拉回路;同时,报警单元中的侧拉故障报警单元发出报警;
与此同时,右侧侧拉限位故障判别器将差值Δl2m与侧拉限位故障阀值El进行比较后,输出故障型号判断信号的逻辑值SCR,并将该逻辑值SCR输送给报警单元中的侧拉限位故障报警单元;根据判断,若当Δl2m<El时,右侧侧拉限位故障判别器输出逻辑值SCR=0,则表示该侧拉过程虽超出设定的限位值lm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元中的侧拉限位故障报警单元不发出报警信号,报警单元不发出侧拉限位故障报警;当Δl2m≥El时,右侧侧拉限位故障判别器输出逻辑值SCR=1,则表示该侧拉过程不但超出了设定的限位值lm,而且还超出故障限定阀值El,因此发生限位故障,此时报警单元中的侧拉限位故障报警单元发出报警信号,报警单元发出侧拉限位故障报警;同时,侧拉逻辑加法器接收该报警逻辑值SCR,产生故障逻辑信号SL,此时SL=1同时输出给运动控制单元中的侧拉控制逻辑开关及报警单元中侧拉故障报警单元,并控制侧拉控制逻辑开关断开,切断侧拉回路;同时,报警单元中的侧拉故障报警单元发出报警;
与此同时,左侧侧拉限位故障判别器将差值Δl1m与侧拉限位故障阀值El进行比较后,输出故障型号判断信号的逻辑值SCL,并将该逻辑值SCL输送给报警单元中的侧拉限位故障报警单元;根据判断,若当Δl1m<El时,左侧侧拉限位故障判别器输出逻辑值SCL=0,则表示该侧拉过程虽超出设定的限位值lm,但没有超出故障发生值El,因此没有发生限位故障,此时报警单元中的侧拉限位故障报警单元不发出报警信号,报警单元不发出侧拉限位故障报警;当Δl1m≥El时,左侧侧拉限位故障判别器输出逻辑值SCL=1,则表示该侧拉过程不但超出了设定的限位值lm,而且还超出了故障限定阀值El,因此发生限位故障,此时报警单元中的侧拉限位故障报警单元发出报警信号,报警单元发出侧拉限位故障报警;同时,侧拉逻辑加法器接收该报警逻辑值SCL,产生故障逻辑信号SL,此时SL=1,同时输出给运动控制单元中的侧拉控制逻辑开关及报警单元中侧拉故障报警单元,并控制侧拉控制逻辑开关断开,切断侧拉回路;同时,报警单元中的侧拉故障报警单元发出报警;
若侧拉过程同时发生了侧拉不平衡故障、左侧侧拉限位故障和右侧侧拉限位故障,则侧拉逻辑加法器将接收到的报警逻辑值SC、SCL、SCR三个信号相加后,产生故障逻辑信号SL,同时输出给运动控制单元中的侧拉控制逻辑开关及报警单元中侧拉故障报警单元,并控制侧拉控制逻辑开关断开,切断侧拉回路;同时,报警单元中的侧拉故障报警单元发出重大紧急报警;
其中,侧拉逻辑加法器为逻辑和门加法器SL的计算公式为:
SL=SC+SCL+SCR 公式(8)
进一步的,在步骤五中,顶升控制过程的具体步骤如下:
步骤1,通信单元通过无线网络接收中央控制器发出的顶升控制命令hR,并将该顶升控制命令hR发送给运动控制单元;同时,通信单元接收顶升限位值设定命令hm、顶升故障阀值设定命令Eh、顶升不平衡故障阀值设定命令εh,将这些命令发送至报警单元进行参数设定;
步骤2,运动控制单元接收顶升控制命令hR,其内部的顶升控制逻辑开关闭合,形成控制回路;此时顶升控制命令hR经过顶升控制逻辑开关分别输送到左侧顶升信号比较器、右侧顶升信号比较器,同时,状态检测单元通过左侧超声波测距传感器、右侧超声波测距传感器分别检测接运装置左侧支架、右侧支架顶升状态,得到左侧支架的顶升位置高度值h1和右侧支架的顶升位置高度值h2;左侧顶升信号比较器将顶升控制命令hR与左侧支架的顶升位置高度值h1进行比较得到左侧支架的顶升控制量Δu1,右侧顶升信号比较器将顶升控制命令hR与右侧支架的顶升位置高度值h2进行比较得到右侧支架的顶升控制量Δu2;运动控制单元通过顶升控制量Δu1和Δu2分别控制接运装置左右两侧的顶升油缸,从而控制控制接运左侧支架和右侧支架的顶升运动;直到顶升位置到达控制命令要到达到的位置hR位置;
Δu1和Δu2的计算公式如下:
hR-h1=Δu1 公式(9)
hR-h2=Δu2 公式(10)
当控制量Δu1=0和Δu2=0时,表示顶升已经到达所要顶升的位置,此时停止顶升运动;
步骤3,在接运装置的左侧支架和右侧支架顶升的过程中,状态检测单元实时进行左侧支架的顶升位置高度值h1和右侧支架的顶升位置高度值h2的检测,并对顶升位置高度值h1、h2进行分析比较,判断顶升是否正常;并向报警单元发出告警信号,报警单元接收报警信号后发出报警,具体步骤如下:
(1)信号检测:左侧超声波测距传感器检测到左侧支架的顶升运动的位置高度值h1,并分别将该位置高度值h1输送给第一比较器和第三比较器;同时,右侧超声波测距传感器检测到右侧支架的顶升运动的位置高度值h2,并分别将该位置高度值h2输送给第一比较器和第二比较器;
(2)信号比较分析:
第一比较器接收左侧顶升位置高度值h1和右侧顶升位置高度值h2,将左侧顶升位置高度值h1和右侧顶升位置高度值h2进行比较产生左右两侧顶升运动的差值Δh,并将该差值Δh发送至顶升不平衡故障判别器进行分析;
Δh的计算公式为:
h1-h2=Δh 公式(11)
与此同时,第二比较器将右侧顶升位置高度值h2与顶升限位值hm进行比较,产生右侧支架顶升与限位值之间的差值Δh2m,并将该差值Δh2m发送至右侧顶升限位故障判别器进行分析;
Δh2m的计算公式为:
h2-hm=Δh2m 公式(12)
与此同时,第三比较器将左侧顶升位置高度值h1与顶升限位值hm进行比较,产生左侧支架顶升与限位值之间的差值Δh1m,并将该差值Δh1m发送至左侧顶升限位故障判别器进行分析;
Δh1m的计算公式为:
h1-hm=Δh1m 公式(13)
(3)故障判断及报警:
顶升不平衡故障判别器将差值Δh与设定的顶升不平衡故障阀值εh进行比较后,输出故障信号判断信号的逻辑值SB,并将该逻辑值SB输送给报警单元中的顶升不平衡报警单元;根据判断,若|Δh|<εh时,顶升不平衡故障判别器输出逻辑值SB=0,则表示该顶升过程没有超出顶升不平衡故障阀值εh,没有发生不平衡故障,此时顶升不平衡报警单元不发出报警信号,报警单元不发出告警;若|Δh|≥εh时,顶升不平衡故障判别器输出逻辑值SB=1,则表示顶升过程超过了顶升不平衡故障阀值εh,发生了不平衡故障;此时顶升不平衡报警单元发出报警信号,报警单元中侧拉不平衡报警单元发出报警;同时,顶升逻辑加法器接收该报警逻辑值SB,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元中的顶升控制逻辑开关及报警单元中顶升故障报警单元,并控制顶升控制逻辑开关断开,切断顶升回路;同时,报警单元中的顶升故障报警单元发出报警;
与此同时,右侧顶升限位故障判别器将差值Δh2m与顶升限位故障阀值Eh进行比较后,输出故障型号判断信号的逻辑值SBR,并将该逻辑值SBR输送给报警单元中的顶升限位故障报警单元;根据判断,若当Δh2m<Eh时,右侧顶升限位故障判别器输出逻辑值SBR=0,则表示该顶升过程虽超出设定的限位值hm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元中的顶升限位故障报警单元不发出报警信号,报警单元不发出顶升限位故障报警;当Δh2m≥Eh时,右侧顶升限位故障判别器输出逻辑值SBR=1,则表示该顶升过程不但超出了设定的限位值hm,而且还超出故障限定阀值Eh,因此发生限位故障,此时报警单元中的顶升限位故障报警单元发出报警信号,报警单元发出顶升限位故障报警;同时,顶升逻辑加法器接收该报警逻辑值SBR,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元中的顶升控制逻辑开关及报警单元中顶升故障报警单元,并控制顶升控制逻辑开关断开,切断顶升回路;同时,报警单元中的顶升故障报警单元发出报警;
与此同时,左侧顶升限位故障判别器将差值Δh1m与顶升限位故障阀值Eh进行比较后,输出故障型号判断信号的逻辑值SBL,并将该逻辑值SBL输送给报警单元中的顶升限位故障报警单元;根据判断,若当Δh1m<Eh时,左侧顶升限位故障判别器输出逻辑值SBL=0,则表示该顶升过程虽超出设定的限位值hm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元中的顶升限位故障报警单元不发出报警信号,报警单元不发出顶升限位故障报警;当Δh1m≥Eh时,左侧顶升限位故障判别器输出逻辑值SBL=1,则表示该顶升过程不但超出了设定的限位值hm,而且还超出了故障限定阀值Eh,因此发生限位故障,此时报警单元中的顶升限位故障报警单元发出报警信号,报警单元发出顶升限位故障报警;同时,顶升逻辑加法器接收该报警逻辑值SBL,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元中的顶升控制逻辑开关及报警单元中顶升故障报警单元,并控制顶升控制逻辑开关断开,切断顶升回路;同时,报警单元中的顶升故障报警单元发出报警;
若顶升过程同时发生了顶升不平衡故障、左侧顶升限位故障和右侧顶升限位故障,则顶升逻辑加法器将接收到的报警逻辑值SB、SBL、SBR三个信号相加后,产生故障逻辑信号SH,同时输出给运动控制单元中的顶升控制逻辑开关及报警单元中顶升故障报警单元,并控制顶升控制逻辑开关断开,切断顶升回路;同时,报警单元中的顶升故障报警单元发出重大紧急报警;
其中,顶升逻辑加法器为逻辑和门加法器SH的计算公式为:
SH=SB+SBL+SBR 公式(14)
与现有技术相比,采用上述方案,本发明的有益效果是:本发明将智能化码头的AGV卸载和装载集装箱的运输和存放过程分离开来,有效解决了智能化码头ARMG和AGV之间的耦合问题;在控制系统中采用同一套超声波测距传感器,既可测量接运装置的顶升位置又可测量接运装置的侧拉位置,这使得大大简化了接运装置的结构;同时超声波测距采用非接触式测距,延长了传感器的使用寿命,且检测精度高;本发明大大提高了智能化码头AGV平面运输工作效率和装卸生产率,同时也有效减少了智能化码头平面运输需要配置的AGV的数量。
附图说明
图1是本发明的结构示意图;
图2是本发明的顶升控制系统内部结构示意图;
图3是本发明的侧拉控制系统内部结构示意图;
具体实施方式
下面结合附图和实施例对本发明进一步说明。
如图1、图2、图3所示,一种用于智能接运装置的控制系统,包括与液压系统500相连的运动控制单元100、与接运装置相连的状态检测单元200、报警单元300、与中央控制系统相连的通信单元400;通信单元400分别与运动控制单元100、报警单元300连接;所述运动控制单元100与状态检测单元200连接;所述报警单元300与状态检测单元200连接;
本发明利用上述控制系统进行接运装置控制的方法,具体的控制方法如下:
步骤一,中央控制系统监控到集装箱拖运装置进入接运装置的设定范围内后,向本发明接运装置控制系统发出侧拉控制命令lR,同时发出相关参数的设置命令,即侧拉限位值设定命令lm、侧拉不平衡故障阀值设定命令εl和侧拉限位故障阀值设定命令El;
步骤二、接运装置控制系统中的通信单元400通过无线网络接收侧拉控制命令lR及相关参数设定命令lm、εl和El后,分别向运动控制单元100、报警单元300发出侧拉控制命令lR、参数设定命令lm、εl和El,报警单元300接收参数设定命令后,对相关参数进行设定;运动控制单元100接收侧拉控制命令后,向接运装置的左右两侧支架上的侧拉油缸发出侧拉信号,形成侧拉回路,通过油缸控制左右两个支架向两侧实现侧拉,当侧拉到达设定的限位位置后,侧拉完成;
步骤三、侧拉完成后,集装箱拖运装置进入侧拉范围后,运动控制单元100侧拉回路切断,侧拉归位;
步骤四、待侧拉归位完成后,需要将集装箱向上顶起,运至装箱位置,此时,中央控制系统向接运装置控制系统发出顶升控制命令hR,同时发出顶升相关参数设定命令,即顶升限位值设定命令hm、顶升故障阀值设定命令Eh、顶升不平衡故障阀值设定命令εh;
步骤五、接运装置控制系统中的通信单元400通过无线网络接收顶升控制命令hR及相关参数设定命令hm、εh和Eh后,分别向运动控制单元100、报警单元300发出顶升控制命令hR和相关参数设定命令hm、εh和Eh,报警单元300接收参数设定命令后,对相关参数进行设定;运动控制单元100接收顶升控制命令后,向接运装置的左右两侧支架上的顶升油缸发出顶升信号,形成顶升回路,通过油缸控制左右两个支架向上方实现顶升,当顶升到达设定的限位位置后,顶升完成;
步骤六、待顶升完成后,顶升控制回路切断,顶升归位,顶升归位完成后,即完成一次接运过程;
进一步的,在步骤二,侧拉控制过程的具体步骤如下:
步骤1,通信单元400通过无线网络接收中央控制器发出的侧拉控制命令lR,并将该侧拉控制命令lR发送给运动控制单元100;同时,通信单元接收侧拉限位值设定命令lm、侧拉不平衡故障阀值设定命令εl和侧拉限位故障阀值设定命令El,将这些命令发送至报警单元300进行参数设定;
步骤2,运动控制单元100接收侧拉控制命令lR,其内部的侧拉控制逻辑开关121闭合,形成控制回路;此时侧拉控制命令lR经过侧拉控制逻辑开关121分别输送到左侧侧拉信号比较器122、右侧侧拉信号比较器123,同时,状态检测单元200通过左侧超声波测距传感器211、右侧超声波测距传感器212分别检测接运装置左侧支架、右侧支架侧拉状态,得到左侧支架的侧拉位置高度值h1和右侧支架的侧拉位置高度值h2;左侧拉位置高度值h1和右侧拉位置高度值h2分别被输送到状态检测单元中的侧拉距离运算器,得出左侧支架、右侧支架的侧拉距离值,其中左侧支架的侧拉距离值为l1,右侧支架的侧拉距离值为l2,左侧侧拉信号比较器122将侧拉控制命令lR与左侧支架的侧拉距离值l1进行比较得到左侧支架的侧拉控制量Δv1,右侧侧拉信号比较器123将侧拉控制命令lR与左侧支架的侧拉距离值l2进行比较得到左侧支架的侧拉控制量Δv2;运动控制单元100通过侧拉控制量Δv1和Δv2分别控制接运装置左右两侧的侧拉油缸,从而控制控制接运左侧支架和右侧支架的侧拉运动;直到侧拉位置到达控制命令要到达到的位置lR位置;H为左侧支架和右侧支架的基本高度;
左侧支架的侧拉距离值l1和右侧支架的侧拉距离值l2的计算公式如下:
左侧拉控制量Δv1和右侧拉控制量Δv2的计算公式如下:
lR-l1=Δv1 公式(3)
lR-l2=Δv2 公式(4)
当控制量Δv1=0和Δv2=0时,表示侧拉已经到达所要侧拉的位置,此时停止侧拉运动;
步骤3,在接运装置的左侧支架和右侧支架侧拉的过程中,状态检测单元200实时进行左侧支架的侧拉位置高度值h1和右侧支架的侧拉位置高度值h2的检测,经过内部的侧拉距离运算器计算得到左侧支架、右侧支架的侧拉距离值l1和l2,并对侧拉距离值l1、l2进行分析比较,判断侧拉是否正常;并向报警单元300发出告警信号,报警单元300接收报警信号后发出报警,具体步骤如下:
(1)信号检测:经过侧拉距离运算器计算后的侧拉距离值l1、l2分别被输送给第四比较器231、第五比较器233和第六比较器232;
(2)信号比较分析:
第四比较器231接收左侧侧拉距离值l1和右侧侧拉距离值l2,将左侧侧拉距离值l1和右侧侧拉距离值l2进行比较产生左右两侧侧拉运动的差值Δl,并将该差值Δh发送至侧拉不平衡故障判别器234进行分析;
Δl的计算公式为:
l1-l2=Δl 公式(5)
与此同时,第五比较器233将右侧侧拉距离值l2与侧拉限位值lm进行比较,产生右侧支架侧拉与限位值之间的差值Δl2m,并将该差值Δl2m发送至右侧侧拉限位故障判别器236进行分析;
Δl2m的计算公式为:
l2-lm=Δl2m 公式(6)
与此同时,第六比较器232将左侧侧拉距离值l1与侧拉限位值lm进行比较,产生右侧支架侧拉与限位值之间的差值Δl1m,并将该差值Δl1m发送至左侧侧拉限位故障判别器235进行分析;
Δl1m的计算公式为:
l1-lm=Δl1m 公式(7)
(3)故障判断及报警:
侧拉不平衡故障判别器234将差值Δl与设定的侧拉不平衡故障阀值εl进行比较后,输出故障信号判断信号的逻辑值SC,并将该逻辑值SC输送给报警单元300中的侧拉不平衡报警单元300;根据判断,若|Δl|<εl时,侧拉不平衡故障判别器234输出逻辑值SC=0,则表示该侧拉过程没有超出侧拉不平衡故障阀值εl,没有发生不平衡故障,此时侧拉不平衡报警单元300不发出报警信号,报警单元300不发出告警;若|Δl|≥εl时,侧拉不平衡故障判别器234输出逻辑值SC=1,则表示侧拉过程超过了侧拉不平衡故障阀值εl,发生了不平衡故障;此时侧拉不平衡报警单元300发出报警信号,报警单元300中侧拉不平衡报警单元300发出报警;同时,侧拉逻辑加法器237接收该报警逻辑值SC,产生故障逻辑信号SL,此时SL=1,同时输出给运动控制单元100中的侧拉控制逻辑开关121及报警单元300中侧拉故障报警单元,并控制侧拉控制逻辑开关121断开,切断侧拉回路;同时,报警单元300中的侧拉故障报警单元发出报警;
与此同时,右侧侧拉限位故障判别器236将差值Δl2m与侧拉限位故障阀值El进行比较后,输出故障型号判断信号的逻辑值SCR,并将该逻辑值SCR输送给报警单元300中的侧拉限位故障报警单元300;根据判断,若当Δl2m<El时,右侧侧拉限位故障判别器236输出逻辑值SCR=0,则表示该侧拉过程虽超出设定的限位值lm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元300中的侧拉限位故障报警单元300不发出报警信号,报警单元300不发出侧拉限位故障报警;当Δl2m≥El时,右侧侧拉限位故障判别器236输出逻辑值SCR=1,则表示该侧拉过程不但超出了设定的限位值lm,而且还超出故障限定阀值El,因此发生限位故障,此时报警单元300中的侧拉限位故障报警单元300发出报警信号,报警单元300发出侧拉限位故障报警;同时,侧拉逻辑加法器237接收该报警逻辑值SCR,产生故障逻辑信号SL,此时SL=1同时输出给运动控制单元100中的侧拉控制逻辑开关121及报警单元300中侧拉故障报警单元,并控制侧拉控制逻辑开关121断开,切断侧拉回路;同时,报警单元300中的侧拉故障报警单元发出报警;
与此同时,左侧侧拉限位故障判别器235将差值Δl1m与侧拉限位故障阀值El进行比较后,输出故障型号判断信号的逻辑值SCL,并将该逻辑值SCL输送给报警单元300中的侧拉限位故障报警单元300;根据判断,若当Δl1m<El时,左侧侧拉限位故障判别器235输出逻辑值SCL=0,则表示该侧拉过程虽超出设定的限位值lm,但没有超出故障发生值El,因此没有发生限位故障,此时报警单元300中的侧拉限位故障报警单元300不发出报警信号,报警单元300不发出侧拉限位故障报警;当Δl1m≥El时,左侧侧拉限位故障判别器235输出逻辑值SCL=1,则表示该侧拉过程不但超出了设定的限位值lm,而且还超出了故障限定阀值El,因此发生限位故障,此时报警单元300中的侧拉限位故障报警单元300发出报警信号,报警单元300发出侧拉限位故障报警;同时,侧拉逻辑加法器237接收该报警逻辑值SCL,产生故障逻辑信号SL,此时SL=1,同时输出给运动控制单元100中的侧拉控制逻辑开关121及报警单元300中侧拉故障报警单元,并控制侧拉控制逻辑开关121断开,切断侧拉回路;同时,报警单元300中的侧拉故障报警单元发出报警;
若侧拉过程同时发生了侧拉不平衡故障、左侧侧拉限位故障和右侧侧拉限位故障,则侧拉逻辑加法器237将接收到的报警逻辑值SC、SCL、SCR三个信号相加后,产生故障逻辑信号SL,同时输出给运动控制单元100中的侧拉控制逻辑开关121及报警单元300中侧拉故障报警单元,并控制侧拉控制逻辑开关121断开,切断侧拉回路;同时,报警单元300中的侧拉故障报警单元发出重大紧急报警;
其中,侧拉逻辑加法器237为逻辑和门加法器SL的计算公式为:
SL=SC+SCL+SCR 公式(8)
进一步的,在步骤五中,顶升控制过程的具体步骤如下:
步骤1,通信单元400通过无线网络接收中央控制器发出的顶升控制命令hR,并将该顶升控制命令hR发送给运动控制单元100;同时,通信单元接收顶升限位值设定命令hm、顶升故障阀值设定命令Eh、顶升不平衡故障阀值设定命令εh,将这些命令发送至报警单元300进行参数设定;
步骤2,运动控制单元100接收顶升控制命令hR,其内部的顶升控制逻辑开关111闭合,形成控制回路;此时顶升控制命令hR经过顶升控制逻辑开关111分别输送到左侧顶升信号比较器112、右侧顶升信号比较器113,同时,状态检测单元200通过左侧超声波测距传感器211、右侧超声波测距传感器212分别检测接运装置左侧支架、右侧支架顶升状态,得到左侧支架的顶升位置高度值h1和右侧支架的顶升位置高度值h2;左侧顶升信号比较器112将顶升控制命令hR与左侧支架的顶升位置高度值h1进行比较得到左侧支架的顶升控制量Δu1,右侧顶升信号比较器113将顶升控制命令hR与右侧支架的顶升位置位置高度值h2进行比较得到右侧支架的顶升控制量Δu2;运动控制单元100通过顶升控制量Δu1和Δu2分别控制接运装置左右两侧的顶升油缸,从而控制控制接运左侧支架和右侧支架的顶升运动;直到顶升位置到达控制命令要到达到的位置hR位置;
Δu1和Δu2的计算公式如下:
hR-h1=Δu1 公式(9)
hR-h2=Δu2 公式(10)
当控制量Δu1=0和Δu2=0时,表示顶升已经到达所要顶升的位置,此时停止顶升运动;
步骤3,在接运装置的左侧支架和右侧支架顶升的过程中,状态检测单元200实时进行左侧支架的顶升位置高度值h1和右侧支架的顶升位置高度值h2的检测,并对顶升位置高度值h1、h2进行分析比较,判断顶升是否正常;并向报警单元300发出告警信号,报警单元300接收报警信号后发出报警,具体步骤如下:
(1)信号检测:左侧超声波测距传感器检测到左侧支架的顶升运动的位置高度值h1,并分别将该位置高度值h1输送给第一比较器221和第三比较器222;同时,右侧超声波测距传感器212检测到右侧支架的顶升运动的位置高度值h2,并分别将该位置高度值h2输送给第一比较器221和第二比较器223;
(2)信号比较分析:
第一比较器221接收左侧顶升位置高度值h1和右侧顶升位置高度值h2,将左侧顶升位置高度值h1和右侧顶升位置高度值h2进行比较产生左右两侧顶升运动的差值Δh,并将该差值Δh发送至顶升不平衡故障判别器224进行分析;
Δh的计算公式为:
h1-h2=Δh 公式(11)
与此同时,第二比较器223将右侧顶升位置高度值h2与顶升限位值hm进行比较,产生右侧支架顶升与限位值之间的差值Δh2m,并将该差值Δh2m发送至右侧顶升限位故障判别器226进行分析;
Δh2m的计算公式为:
h2-hm=Δh2m 公式(12)
与此同时,第三比较器222将左侧顶升位置高度值h1与顶升限位值hm进行比较,产生左侧支架顶升与限位值之间的差值Δh1m,并将该差值Δh1m发送至左侧顶升限位故障判别器225进行分析;
Δh1m的计算公式为:
h1-hm=Δh1m 公式(13)
(3)故障判断及报警:
顶升不平衡故障判别器224将差值Δh与设定的顶升不平衡故障阀值εh进行比较后,输出故障信号判断信号的逻辑值SB,并将该逻辑值SB输送给报警单元300中的顶升不平衡报警单元;根据判断,若|Δh|<εh时,顶升不平衡故障判别器224输出逻辑值SB=0,则表示该顶升过程没有超出顶升不平衡故障阀值εh,没有发生不平衡故障,此时顶升不平衡报警单元不发出报警信号,报警单元300不发出告警;若|Δh|≥εh时,顶升不平衡故障判别器224输出逻辑值SB=1,则表示顶升过程超过了顶升不平衡故障阀值εh,发生了不平衡故障;此时顶升不平衡报警单元发出报警信号,报警单元300中侧拉不平衡报警单元300发出报警;同时,顶升逻辑加法器227接收该报警逻辑值SB,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元100中的顶升控制逻辑开关111及报警单元300中顶升故障报警单元,并控制顶升控制逻辑开关111断开,切断顶升回路;同时,报警单元300中的顶升故障报警单元发出报警;
与此同时,右侧顶升限位故障判别器226将差值Δh2m与顶升限位故障阀值Eh进行比较后,输出故障型号判断信号的逻辑值SBR,并将该逻辑值SBR输送给报警单元300中的顶升限位故障报警单元300;根据判断,若当Δh2m<Eh时,右侧顶升限位故障判别器226输出逻辑值SBR=0,则表示该顶升过程虽超出设定的限位值hm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元300中的顶升限位故障报警单元300不发出报警信号,报警单元300不发出顶升限位故障报警;当Δh2m≥Eh时,右侧顶升限位故障判别器226输出逻辑值SBR=1,则表示该顶升过程不但超出了设定的限位值hm,而且还超出故障限定阀值Eh,因此发生限位故障,此时报警单元300中的顶升限位故障报警单元300发出报警信号,报警单元300发出顶升限位故障报警;同时,顶升逻辑加法器227接收该报警逻辑值SBR,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元100中的顶升控制逻辑开关111及报警单元300中顶升故障报警单元,并控制顶升控制逻辑开关111断开,切断顶升回路;同时,报警单元300中的顶升故障报警单元发出报警;
与此同时,左侧顶升限位故障判别器225将差值Δh1m与顶升限位故障阀值Eh进行比较后,输出故障型号判断信号的逻辑值SBL,并将该逻辑值SBL输送给报警单元300中的顶升限位故障报警单元300;根据判断,若当Δh1m<Eh时,左侧顶升限位故障判别器225输出逻辑值SBL=0,则表示该顶升过程虽超出设定的限位值hm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元300中的顶升限位故障报警单元300不发出报警信号,报警单元300不发出顶升限位故障报警;当Δh1m≥Eh时,左侧顶升限位故障判别器225输出逻辑值SBL=1,则表示该顶升过程不但超出了设定的限位值hm,而且还超出了故障限定阀值Eh,因此发生限位故障,此时报警单元300中的顶升限位故障报警单元300发出报警信号,报警单元300发出顶升限位故障报警;同时,顶升逻辑加法器227接收该报警逻辑值SBL,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元100中的顶升控制逻辑开关111及报警单元300中顶升故障报警单元,并控制顶升控制逻辑开关111断开,切断顶升回路;同时,报警单元300中的顶升故障报警单元发出报警;
若顶升过程同时发生了顶升不平衡故障、左侧顶升限位故障和右侧顶升限位故障,则顶升逻辑加法器227将接收到的报警逻辑值SB、SBL、SBR三个信号相加后,产生故障逻辑信号SH,同时输出给运动控制单元100中的顶升控制逻辑开关111及报警单元300中顶升故障报警单元,并控制顶升控制逻辑开关111断开,切断顶升回路;同时,报警单元300中的顶升故障报警单元发出重大紧急报警;
其中,顶升逻辑加法器227为逻辑和门加法器SH的计算公式为:
SH=SB+SBL+SBR 公式(14)
该方法包括顶升控制、侧拉控制;且顶升控制与侧拉控制是互锁的,若系统执行顶升控制、则侧拉控制不工作;若系统执行侧拉控制,则顶升控制不工作;
本发明将智能化码头的AGV卸载和装载集装箱的运输和存放过程分离开来,有效解决了智能化码头ARMG和AGV之间的耦合问题;在控制系统中采用同一套超声波测距传感器,既可测量接运装置的顶升位置又可测量接运装置的侧拉位置,这使得大大简化了接运装置的结构;同时超声波测距采用非接触式测距,延长了传感器的使用寿命,且检测精度高;本发明大大提高了智能化码头AGV平面运输工作效率和装卸生产率,同时也有效减少了智能化码头平面运输需要配置的AGV的数量;
本发明不局限于上述具体的实施方式,本领域的普通技术人员从上述构思出发,不经过创造性的劳动,所作出的种种变换,均落在本发明的保护范围之内。
Claims (3)
1.一种用于智能接运装置的控制系统进行控制的方法,其特征在于:具体的控制方法如下:
步骤一,中央控制系统监控到集装箱拖运装置进入接运装置的设定范围内后,向接运装置控制系统发出侧拉控制命令lR,同时发出相关参数的设置命令,即侧拉限位值设定命令lm、侧拉不平衡故障阀值设定命令εl和侧拉限位故障阀值设定命令El;
步骤二、接运装置控制系统中的通信单元通过无线网络接收侧拉控制命令lR及相关参数设定命令lm、εl和El后,分别向运动控制单元、报警单元发出侧拉控制命令lR、参数设定命令lm、εl和El,报警单元接收参数设定命令后,对相关参数进行设定;运动控制单元接收侧拉控制命令后,向接运装置的左右两侧支架上的侧拉油缸发出侧拉信号,形成侧拉回路,通过油缸控制左右两个支架向两侧实现侧拉,当侧拉到达设定的限位位置后,侧拉完成;
步骤三、侧拉完成后,集装箱拖运装置进入侧拉范围后,运动控制单元侧拉回路切断,侧拉归位;
步骤四、待侧拉归位完成后,需要将集装箱向上顶起,运至装箱位置,此时,中央控制系统向接运装置控制系统发出顶升控制命令hR,同时发出顶升相关参数设定命令,即顶升限位值设定命令hm、顶升故障阀值设定命令Eh、顶升不平衡故障阀值设定命令εh;
步骤五、接运装置控制系统中的通信单元通过无线网络接收顶升控制命令hR及相关参数设定命令hm、εh和Eh后,分别向运动控制单元、报警单元发出顶升控制命令hR和相关参数设定命令hm、εh和Eh,报警单元接收参数设定命令后,对相关参数进行设定;运动控制单元接收顶升控制命令后,向接运装置的左右两侧支架上的顶升油缸发出顶升信号,形成顶升回路,通过油缸控制左右两个支架向上方实现顶升,当顶升到达设定的限位位置后,顶升完成;
步骤六、待顶升完成后,顶升控制回路切断,顶升归位,顶升归位完成后,即完成一次接运过程。
2.根据权利要求1所述的控制方法,其特征在于:在步骤二,侧拉控制过程的具体步骤如下:
步骤1,通信单元通过无线网络接收中央控制器发出的侧拉控制命令lR,并将该侧拉控制命令lR发送给运动控制单元;同时,通信单元接收侧拉限位值设定命令lm、侧拉不平衡故障阀值设定命令εl和侧拉限位故障阀值设定命令El,将这些命令发送至报警单元进行参数设定;
步骤2,运动控制单元接收侧拉控制命令lR,其内部的侧拉控制逻辑开关闭合,形成控制回路;此时侧拉控制命令lR经过侧拉控制逻辑开关分别输送到左侧侧拉信号比较器、右侧侧拉信号比较器,同时,状态检测单元通过左侧超声波测距传感器、右侧超声波测距传感器分别检测接运装置左侧支架、右侧支架侧拉状态,得到左侧支架的侧拉位置高度值h1和右侧支架的侧拉位置高度值h2;左侧拉位置高度值h1和右侧拉位置高度值h2分别被输送到检测单元中的侧拉距离运算器,得出左侧支架、右侧支架的侧拉距离值,其中左侧支架的侧拉距离值为l1,右侧支架的侧拉距离值为l2,左侧侧拉信号比较器将侧拉控制命令lR与左侧支架的侧拉距离值l1进行比较得到左侧支架的侧拉控制量Δv1,右侧侧拉信号比较器将侧拉控制命令lR与右侧支架的侧拉距离值l2进行比较得到右侧支架的侧拉控制量Δv2;运动控制单元通过侧拉控制量Δv1和Δv2分别控制接运装置左右两侧的侧拉油缸,从而控制控制接运左侧支架和右侧支架的侧拉运动;直到侧拉位置到达控制命令要到达到的位置lR位置;H为左侧支架和右侧支架的基本高度;
左侧支架的侧拉距离值l1和右侧支架的侧拉距离值l2的计算公式如下:
左侧拉控制量Δv1和右侧拉控制量Δv2的计算公式如下:
lR-l1=Δv1 公式(3)
lR-l2=Δv2 公式(4)
当控制量Δv1=0和Δv2=0时,表示侧拉已经到达所要侧拉的位置,此时停止侧拉运动;
步骤3,在接运装置的左侧支架和右侧支架侧拉的过程中,状态检测单元实时进行左侧支架的侧拉位置高度值h1和右侧支架的侧拉位置高度值h2的检测,经过内部的侧拉距离运算器计算得到左侧支架、右侧支架的侧拉距离值l1和l2,并对侧拉距离值l1、l2进行分析比较,判断侧拉是否正常;并向报警单元发出告警信号,报警单元接收报警信号后发出报警,具体步骤如下:
(1)信号检测:经过侧拉距离运算器计算后的侧拉距离值l1、l2分别被输送给第四比较器、第五比较器和第六比较器;
(2)信号比较分析:
第四比较器接收左侧侧拉距离值l1和右侧侧拉距离值l2,将左侧侧拉距离值l1和右侧侧拉距离值l2进行比较产生左右两侧侧拉运动的差值Δl,并将该差值Δl发送至侧拉不平衡故障判别器进行分析;
Δl的计算公式为:
l1-l2=Δl 公式(5)
与此同时,第五比较器将右侧侧拉距离值l2与侧拉限位值lm进行比较,产生右侧支架侧拉与限位值之间的差值Δl2m,并将该差值Δl2m发送至右侧侧拉限位故障判别器进行分析;
Δl2m的计算公式为:
l2-lm=Δl2m 公式(6)
与此同时,第六比较器将左侧侧拉距离值l1与侧拉限位值lm进行比较,产生左侧支架侧拉与限位值之间的差值Δl1m,并将该差值Δl1m发送至左侧侧拉限位故障判别器进行分析;
Δl1m的计算公式为:
l1-lm=Δl1m 公式(7)
(3)故障判断及报警:
侧拉不平衡故障判别器将差值Δl与设定的侧拉不平衡故障阀值εl进行比较后,输出故障信号判断信号的逻辑值SC,并将该逻辑值SC输送给报警单元中的侧拉不平衡报警单元;根据判断,若|Δl|<εl时,侧拉不平衡故障判别器输出逻辑值SC=0,则表示该侧拉过程没有超出侧拉不平衡故障阀值εl,没有发生不平衡故障,此时侧拉不平衡报警单元不发出报警信号,报警单元不发出告警;若|Δl|≥εl时,侧拉不平衡故障判别器输出逻辑值SC=1,则表示侧拉过程超过了侧拉不平衡故障阀值εl,发生了不平衡故障;此时侧拉不平衡报警单元发出报警信号,报警单元中侧拉不平衡报警单元发出报警;同时,侧拉逻辑加法器接收该报警逻辑值SC,产生故障逻辑信号SL,此时SL=1,同时输出给运动控制单元中的侧拉控制逻辑开关及报警单元中侧拉故障报警单元,并控制侧拉控制逻辑开关断开,切断侧拉回路;同时,报警单元中的侧拉故障报警单元发出报警;
与此同时,右侧侧拉限位故障判别器将差值Δl2m与侧拉限位故障阀值El进行比较后,输出故障型号判断信号的逻辑值SCR,并将该逻辑值SCR输送给报警单元中的侧拉限位故障报警单元;根据判断,若当Δl2m<El时,右侧侧拉限位故障判别器输出逻辑值SCR=0,则表示该侧拉过程虽超出设定的限位值lm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元中的侧拉限位故障报警单元不发出报警信号,报警单元不发出侧拉限位故障报警;当Δl2m≥El时,右侧侧拉限位故障判别器输出逻辑值SCR=1,则表示该侧拉过程不但超出了设定的限位值lm,而且还超出故障限定阀值El,因此发生限位故障,此时报警单元中的侧拉限位故障报警单元发出报警信号,报警单元发出侧拉限位故障报警;同时,侧拉逻辑加法器接收该报警逻辑值SCR,产生故障逻辑信号SL,此时SL=1同时输出给运动控制单元中的侧拉控制逻辑开关及报警单元中侧拉故障报警单元,并控制侧拉控制逻辑开关断开,切断侧拉回路;同时,报警单元中的侧拉故障报警单元发出报警;
与此同时,左侧侧拉限位故障判别器将差值Δl1m与侧拉限位故障阀值El进行比较后,输出故障型号判断信号的逻辑值SCL,并将该逻辑值SCL输送给报警单元中的侧拉限位故障报警单元;根据判断,若当Δl1m<El时,左侧侧拉限位故障判别器输出逻辑值SCL=0,则表示该侧拉过程虽超出设定的限位值lm,但没有超出故障发生值El,因此没有发生限位故障,此时报警单元中的侧拉限位故障报警单元不发出报警信号,报警单元不发出侧拉限位故障报警;当Δl1m≥El时,左侧侧拉限位故障判别器输出逻辑值SCL=1,则表示该侧拉过程不但超出了设定的限位值lm,而且还超出了故障限定阀值El,因此发生限位故障,此时报警单元中的侧拉限位故障报警单元发出报警信号,报警单元发出侧拉限位故障报警;同时,侧拉逻辑加法器接收该报警逻辑值SCL,产生故障逻辑信号SL,此时SL=1,同时输出给运动控制单元中的侧拉控制逻辑开关及报警单元中侧拉故障报警单元,并控制侧拉控制逻辑开关断开,切断侧拉回路;同时,报警单元中的侧拉故障报警单元发出报警;
若侧拉过程同时发生了侧拉不平衡故障、左侧侧拉限位故障和右侧侧拉限位故障,则侧拉逻辑加法器将接收到的报警逻辑值SC、SCL、SCR三个信号相加后,产生故障逻辑信号SL,同时输出给运动控制单元中的侧拉控制逻辑开关及报警单元中侧拉故障报警单元,并控制侧拉控制逻辑开关断开,切断侧拉回路;同时,报警单元中的侧拉故障报警单元发出重大紧急报警;
其中,侧拉逻辑加法器为逻辑和门加法器SL的计算公式为:
SL=SC+SCL+SCR 公式(8)。
3.根据权利要求1所述的控制方法,其特征在于:在步骤五中,顶升控制过程的具体步骤如下:
步骤1,通信单元通过无线网络接收中央控制器发出的顶升控制命令hR,并将该顶升控制命令hR发送给运动控制单元;同时,通信单元接收顶升限位值设定命令hm、顶升故障阀值设定命令Eh、顶升不平衡故障阀值设定命令εh,将这些命令发送至报警单元进行参数设定;
步骤2,运动控制单元接收顶升控制命令hR,其内部的顶升控制逻辑开关闭合,形成控制回路;此时顶升控制命令hR经过顶升控制逻辑开关分别输送到左侧顶升信号比较器、右侧顶升信号比较器,同时,状态检测单元通过左侧超声波测距传感器、右侧超声波测距传感器分别检测接运装置左侧支架、右侧支架顶升状态,得到左侧支架的顶升位置高度值h1和右侧支架的顶升位置高度值h2;左侧顶升信号比较器将顶升控制命令hR与左侧支架的顶升位置高度值h1进行比较得到左侧支架的顶升控制量Δu1,右侧顶升信号比较器将顶升控制命令hR与右侧支架的顶升位置高度值h2进行比较得到右侧支架的顶升控制量Δu2;运动控制单元通过顶升控制量Δu1和Δu2分别控制接运装置左右两侧的顶升油缸,从而控制控制接运左侧支架和右侧支架的顶升运动;直到顶升位置到达控制命令要到达到的位置hR位置;
Δu1和Δu2的计算公式如下:
hR-h1=Δu1 公式(9)
hR-h2=Δu2 公式(10)
当控制量Δu1=0和Δu2=0时,表示顶升已经到达所要顶升的位置,此时停止顶升运动;
步骤3,在接运装置的左侧支架和右侧支架顶升的过程中,状态检测单元实时进行左侧支架的顶升位置高度值h1和右侧支架的顶升位置高度值h2的检测,并对顶升位置高度值h1、h2进行分析比较,判断顶升是否正常;并向报警单元发出告警信号,报警单元接收报警信号后发出报警,具体步骤如下:
(1)信号检测:左侧超声波测距传感器检测到左侧支架的顶升运动的位置高度值h1,并分别将该位置高度值h1输送给第一比较器和第三比较器;同时,右侧超声波测距传感器检测到右侧支架的顶升运动的位置高度值h2,并分别将该位置高度值h2输送给第一比较器和第二比较器;
(2)信号比较分析:
第一比较器接收左侧顶升位置高度值h1和右侧顶升位置高度值h2,将左侧顶升位置高度值h1和右侧顶升位置高度值h2进行比较产生左右两侧顶升运动的差值Δh,并将该差值Δh发送至顶升不平衡故障判别器进行分析;
Δh的计算公式为:
h1-h2=Δh 公式(11)
与此同时,第二比较器将右侧顶升位置高度值h2与顶升限位值hm进行比较,产生右侧支架顶升与限位值之间的差值Δh2m,并将该差值Δh2m发送至右侧顶升限位故障判别器进行分析;
Δh2m的计算公式为:
h2-hm=Δh2m 公式(12)
与此同时,第三比较器将左侧顶升位置高度值h1与顶升限位值hm进行比较,产生左侧支架顶升与限位值之间的差值Δh1m,并将该差值Δh1m发送至左侧顶升限位故障判别器进行分析;
Δh1m的计算公式为:
h1-hm=Δh1m 公式(13)
(3)故障判断及报警:
顶升不平衡故障判别器将差值Δh与设定的顶升不平衡故障阀值εh进行比较后,输出故障信号判断信号的逻辑值SB,并将该逻辑值SB输送给报警单元中的顶升不平衡报警单元;根据判断,若|Δh|<εh时,顶升不平衡故障判别器输出逻辑值SB=0,则表示该顶升过程没有超出顶升不平衡故障阀值εh,没有发生不平衡故障,此时顶升不平衡报警单元不发出报警信号,报警单元不发出告警;若|Δh|≥εh时,顶升不平衡故障判别器输出逻辑值SB=1,则表示顶升过程超过了顶升不平衡故障阀值εh,发生了不平衡故障;此时顶升不平衡报警单元发出报警信号,报警单元中侧拉不平衡报警单元发出报警;同时,顶升逻辑加法器接收该报警逻辑值SB,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元中的顶升控制逻辑开关及报警单元中顶升故障报警单元,并控制顶升控制逻辑开关断开,切断顶升回路;同时,报警单元中的顶升故障报警单元发出报警;
与此同时,右侧顶升限位故障判别器将差值Δh2m与顶升限位故障阀值Eh进行比较后,输出故障型号判断信号的逻辑值SBR,并将该逻辑值SBR输送给报警单元中的顶升限位故障报警单元;根据判断,若当Δh2m<Eh时,右侧顶升限位故障判别器输出逻辑值SBR=0,则表示该顶升过程虽超出设定的限位值hm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元中的顶升限位故障报警单元不发出报警信号,报警单元不发出顶升限位故障报警;当Δh2m≥Eh时,右侧顶升限位故障判别器输出逻辑值SBR=1,则表示该顶升过程不但超出了设定的限位值hm,而且还超出故障限定阀值Eh,因此发生限位故障,此时报警单元中的顶升限位故障报警单元发出报警信号,报警单元发出顶升限位故障报警;同时,顶升逻辑加法器接收该报警逻辑值SBR,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元中的顶升控制逻辑开关及报警单元中顶升故障报警单元,并控制顶升控制逻辑开关断开,切断顶升回路;同时,报警单元中的顶升故障报警单元发出报警;
与此同时,左侧顶升限位故障判别器将差值Δh1m与顶升限位故障阀值Eh进行比较后,输出故障型号判断信号的逻辑值SBL,并将该逻辑值SBL输送给报警单元中的顶升限位故障报警单元;根据判断,若当Δh1m<Eh时,左侧顶升限位故障判别器输出逻辑值SBL=0,则表示该顶升过程虽超出设定的限位值hm,但没有超出故障发生值Eh,因此没有发生限位故障,此时报警单元中的顶升限位故障报警单元不发出报警信号,报警单元不发出顶升限位故障报警;当Δh1m≥Eh时,左侧顶升限位故障判别器输出逻辑值SBL=1,则表示该顶升过程不但超出了设定的限位值hm,而且还超出了故障限定阀值Eh,因此发生限位故障,此时报警单元中的顶升限位故障报警单元发出报警信号,报警单元发出顶升限位故障报警;同时,顶升逻辑加法器接收该报警逻辑值SBL,产生故障逻辑信号SH,此时SH=1,同时输出给运动控制单元中的顶升控制逻辑开关及报警单元中顶升故障报警单元,并控制顶升控制逻辑开关断开,切断顶升回路;同时,报警单元中的顶升故障报警单元发出报警;
若顶升过程同时发生了顶升不平衡故障、左侧顶升限位故障和右侧顶升限位故障,则顶升逻辑加法器将接收到的报警逻辑值SB、SBL、SBR三个信号相加后,产生故障逻辑信号SH,同时输出给运动控制单元中的顶升控制逻辑开关及报警单元中顶升故障报警单元,并控制顶升控制逻辑开关断开,切断顶升回路;同时,报警单元中的顶升故障报警单元发出重大紧急报警;
其中,顶升逻辑加法器为逻辑和门加法器SH的计算公式为:
SH=SB+SBL+SBR 公式(14)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410333289.9A CN104122893B (zh) | 2014-07-14 | 2014-07-14 | 一种用于智能接运装置的控制系统及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410333289.9A CN104122893B (zh) | 2014-07-14 | 2014-07-14 | 一种用于智能接运装置的控制系统及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104122893A CN104122893A (zh) | 2014-10-29 |
CN104122893B true CN104122893B (zh) | 2017-07-18 |
Family
ID=51768346
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410333289.9A Active CN104122893B (zh) | 2014-07-14 | 2014-07-14 | 一种用于智能接运装置的控制系统及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104122893B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109335531B (zh) * | 2018-09-21 | 2020-09-25 | 中电科技(合肥)博微信息发展有限责任公司 | 一种穿梭车取料放料方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201809087U (zh) * | 2010-09-29 | 2011-04-27 | 贾志清 | 一种塔吊监控系统 |
CN102849544A (zh) * | 2012-09-18 | 2013-01-02 | 深圳市特辰科技股份有限公司 | 一种升降架升降控制系统及方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FI20085520L (fi) * | 2008-05-30 | 2009-12-01 | Cargotec Finland Oy | Konttilukki |
CN101700854A (zh) * | 2009-12-02 | 2010-05-05 | 上海能港电气工程科技有限公司 | 岸桥集装箱吊装“最佳高度”监控系统及监控方法 |
KR101216871B1 (ko) * | 2009-12-28 | 2012-12-28 | 울산대학교 산학협력단 | 크레인 충돌 방지 시스템 및 크레인 충돌 방지 제어 방법 |
CN102040070B (zh) * | 2010-12-20 | 2012-09-19 | 中国中元国际工程公司 | 航空集装箱自动化储存设备、储存系统和出入库控制方法 |
CN102815546B (zh) * | 2011-06-07 | 2015-04-01 | 上海振华重工(集团)股份有限公司 | 车辆货物托架和车辆货物托架组 |
CN103241666B (zh) * | 2012-02-14 | 2015-12-16 | 上海振华重工(集团)股份有限公司 | 浮式起重机运行智能监控系统 |
CN202670942U (zh) * | 2012-05-25 | 2013-01-16 | 重庆市万州区宏发实业有限公司 | 载货升降机控制系统 |
CN103723532B (zh) * | 2014-01-13 | 2015-11-18 | 上海海事大学 | 多层框架式集装箱自动化码头堆场装卸系统及其装卸方法 |
-
2014
- 2014-07-14 CN CN201410333289.9A patent/CN104122893B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN201809087U (zh) * | 2010-09-29 | 2011-04-27 | 贾志清 | 一种塔吊监控系统 |
CN102849544A (zh) * | 2012-09-18 | 2013-01-02 | 深圳市特辰科技股份有限公司 | 一种升降架升降控制系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104122893A (zh) | 2014-10-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103523675B (zh) | 轨道吊自动化堆场操作控制系统及集装箱自动装卸方法 | |
CN104085794B (zh) | 一种用于集装箱分布轮廓和位置智能化检测系统及方法 | |
CN103879741B (zh) | 一种用于散货料场的激光防碰撞预警系统 | |
WO2018149087A1 (zh) | 一种智能化全自动堆取料机控制装置 | |
CN107845291A (zh) | 车辆的防撞预警系统及包括其的车辆 | |
CN201882868U (zh) | 集装箱重型堆垛机 | |
CN103458236A (zh) | 危化品物流智能监控系统 | |
CN203740901U (zh) | 轨道吊自动化堆场操作控制系统 | |
CN102285431A (zh) | 通航船舶吃水量实时测量装置及测量方法 | |
CN111891775A (zh) | 智能装车料斗及转运物料的方法 | |
CN105399006A (zh) | 一种无人驾驶堆垛机组控制系统 | |
CN105712055A (zh) | 一种基于gnss的堆取料机位置检测及防碰撞系统 | |
CN105480848A (zh) | 一种港口吊车起重系统及其堆垛方法 | |
CN107655556A (zh) | 一种可称重agv自动小车 | |
CN104122893B (zh) | 一种用于智能接运装置的控制系统及控制方法 | |
CN206720381U (zh) | 一种无人值守桥式装卸船机 | |
CN210558950U (zh) | 一种基于多传感器融合的起重机作业系统 | |
CN205275124U (zh) | 一种无人驾驶堆垛机组控制系统 | |
CN103586876A (zh) | 一种具有周转箱识别功能的机器人系统及其识别方法 | |
CN117139607A (zh) | 一种面对工业硅的智能浇铸方法及系统 | |
CN109814570A (zh) | 一种基于港口集装箱的无人车控制系统及使用方法 | |
CN207425126U (zh) | 车辆的防撞预警系统及包括其的车辆 | |
CN109335714A (zh) | 一种防碰撞取料机及其防碰撞系统 | |
CN201970901U (zh) | 一种运梁车的液压顶升系统 | |
CN214877918U (zh) | 一种新型卸料小车自动控制系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |