一种双通道袋装物料拆垛装车系统及控制方法与流程

摘要: 本发明涉及袋装物料搬运及装车设备,具体涉及一种双通道袋装物料拆垛装车系统及控制方法。背景技术:1、化肥、水泥、粮食和化工产品等物料采用袋装包装后,通常以成托码垛...
一种双通道袋装物料拆垛装车系统及控制方法与流程

本发明涉及袋装物料搬运及装车设备,具体涉及一种双通道袋装物料拆垛装车系统及控制方法。

背景技术:

1、化肥、水泥、粮食和化工产品等物料采用袋装包装后,通常以成托码垛的方式存储。散包装车发货时,需要将托盘上的料包逐包拆出,经输送设备转运后放置在车辆内。采用拆垛机器人和装车机器人能够减少人工搬运,但二者的工作节拍并不相同,拆垛后的料包还需要在装车取料位置进行定位和暂存。

2、在多个拆垛单元共用一条输送线的布置中,不同拆垛单元输出的料包需要在同一物流路径上合流。对于能够变形的袋装物料,合流时的料包间距不易保持,来料相互追赶或叠置会影响后续定位;装车端暂未取料时,也需要协调各拆垛单元停止向共用输送线供料。单纯增加拆垛单元数量,不能同时解决合流干扰和装车端等待期间的供料控制问题。

3、即使两路料包分别输送,仅在三个停料位置均有检测信号时停止上游,也不能识别已经获得释放许可但尚未到达目标段的料包。光电信号在料包经过时与最终停放时均可能出现,若不结合送料任务和电机状态判断,容易提前占用停料位置。对于柔性袋体,规格、摩擦及输送速度变化还会改变停机后的继续移动距离,使固定延时停料与固定间距的批量抓具不匹配。

4、两路共用装车机器人时,固定优先取用同一侧会使另一侧已满料的通道持续等待;仅按最短运动时间选取,有可能反复推迟距离较远的通道。因此,供料许可、定位完成及批次取料选择需要使用相互一致的物料状态,并与具体电机和机器人动作衔接。

技术实现思路

1、本发明要解决的技术问题是:双通道拆垛装车过程中,送料许可与停料状态脱节容易造成在途超供;柔性袋体的停止响应随工况变化,使固定延时定位难以匹配抓取位置;共享装车机器人的固定取料顺序或单纯最短时间调度容易造成一路长时间等待。

2、本发明提供一种双通道袋装物料拆垛装车系统,包括两个拆垛单元、分别连接所述两个拆垛单元的两条输送通道、分别连接所述两条输送通道的两个停料装置、一个共享的装车机器人以及控制器;

3、两条所述输送通道自对应拆垛单元的落料位置至对应停料装置不合流并能够独立启停;每个所述停料装置具有沿输送方向依次排列的三个滚筒停料段,每个滚筒停料段分别设有驱动电机、光电对射传感器和速度检测器;所述装车机器人能够到达两个停料装置,其末端的料包抓取装置具有与三个滚筒停料段分别对应的三个抓取段,各抓取段具有能够伸入滚筒间隙的可张合爪齿,每个滚筒停料段的目标停放中心与对应抓取段的抓取中心相匹配;

4、所述控制器分别连接所述拆垛单元、输送通道、驱动电机、光电对射传感器、速度检测器和装车机器人,并被配置为:

5、对每条通道分别维护各滚筒停料段的定位状态、送料事务占用状态和取料锁定状态,在该通道具有剩余送料任务、不存在未结束的送料事务、未被取料锁定且存在输送路径为空的空停料段时,选择最下游的所述空停料段作为目标段,在下发单包送料许可前预约所述目标段并置位送料事务占用状态,使同一通道同时至多存在一个已获送料许可而尚未完成定位的料包;

6、在所述料包前缘触发目标段的光电对射传感器时,按照传感器位置减去料包前缘至抓取中心的标定距离确定料包的估算中心位置,获取目标段的正向输送速度及与料包配方和所述输送速度对应的停止响应位移,将目标停放中心至所述估算中心位置的距离扣除所述停止响应位移后,除以所述输送速度,得到停机等待时间;在该等待时间非负且配方、速度和停机时序处于预先标定的有效范围时,据此控制对应驱动电机停止,在确认电机停止并且对应传感器持续检测到料包后,将目标段记为定位完成并结束该送料事务,其中所述停止响应位移为控制器发出停止指令至料包停止之间的料包移动距离;

7、在一个停料装置的三个滚筒停料段均定位完成且不存在未结束的送料事务时,产生满料状态,记录该批次首次满料的时刻并暂停对应通道供料;装车机器人空闲时,从满料、未被取料锁定、物料种类与当前装载任务相符且具有可执行搬运任务的停料装置中选择取料来源:只有一个符合条件时选择该停料装置,两个均符合条件时,若其等待时长之差的绝对值大于预设时差阈值,则选择等待较长者,否则选择从机器人当前位姿出发完成该批次取料、装载及返回待命位置的预计搬运时间较短者,预计时间相等时选择等待较长者,仍相等时按固定通道顺序选择;

8、对所选择停料装置置位取料锁定状态并控制所述三个抓取段取料,在收到机器人离开该停料装置取料干涉区域的搬离完成信号且对应三个传感器均确认无料后,清除该停料装置的定位状态、满料状态及取料锁定状态,并依据该通道剩余任务重新判断送料许可;另一通道按照自身状态独立运行。

9、优选地,所述控制器为每次送料事务记录通道标识、目标段标识和事务序号,在同一状态更新中完成目标段预约及送料事务占用状态的置位,再输出带有所述事务序号的单包送料许可;所述目标段及其上游各停料段在预约时均未定位且传感器均确认无料,已定位的下游停料段保持停止;料包经过非目标段传感器的信号不改变该非目标段的定位状态,只有与本次事务对应的目标段完成定位,才结束该送料事务。

10、优选地,所述控制器按停料段和料包配方保存多个标定输送速度及其停止响应位移,所述料包配方包括料包规格、质量范围、袋体材料和放置朝向,料包有效长度的二分之一为所述料包前缘至抓取中心的标定距离;当检测速度位于两个相邻标定速度之间时,对对应的停止响应位移进行线性插值,速度超出标定区间或停机等待时间为负时停止本路输送并禁止将目标段记为定位完成;所述停止响应位移包含停止指令输出后的驱动响应、滚筒减速及袋体继续滑移,不再重复扣除上述响应对应的位移。

11、优选地,所述控制器根据传感器与目标中心位置的误差、料包有效长度误差、等待期间输送速度误差、停止响应位移误差以及输入触发时间戳与停止指令输出的合成时序误差,确定中心位置误差上界,只有所述误差上界不大于对应抓取段允许的纵向定位误差且包含该误差上界的料包外包络位于目标段独立承载范围内时,才允许采用相应配方完成定位;目标传感器触发后保持目标段输送速度设定不变,速度检测器换算的输送线速度偏差超过预设允许速度偏差范围时转入本路故障停止状态。

12、优选地,所述等待时长从当前批次首次形成满料状态的时刻起算,在该批次未被取走期间不因控制器轮询或另一通道被选择而重新起算;所述预计搬运时间由当前位姿至取料位置、取料提升、运往该批次全部装载点位以及空载返回待命位置的可执行轨迹段时间和对应抓放停留时间相加得到;等待时长差未超过所述时差阈值且预计搬运时间相等时选择等待较长者,两者仍相等时按所述固定通道顺序选择;一次批次任务启动后不因另一通道状态变化而切换本次取料来源。

13、优选地,所述控制器在送料许可已下发但料包释放尚未确认期间保持送料事务占用,在释放确认后至目标段定位完成期间继续保持该占用;释放确认超时、输送超时或者定位确认失败时,保留送料事务记录并停止对应通道,不通过清除在途记录恢复送料;仅在确认该送料事务未执行物料释放且取消指令已被确认时撤销预约,或在人工核对现场料包位置后重新建立通道状态。

14、优选地,三个所述抓取段分别由独立电磁阀控制的气缸驱动爪齿张合,所述料包抓取装置还设有向下抵压料包的下压机构;每条所述输送通道包括具有升降机构的落料输送段以及输运段,所述控制器在料包释放时使其底面与落料输送段承载面之间的距离处于预设范围内,并在落料输送段与输运段完成高度对接后允许料包向输运段输送。

15、优选地,每个所述拆垛单元包括拆垛机器人、料包识别装置及具有负压传感器和压板的吸附抓具;所述料包识别装置通过料包图像区域与三维点云的空间对应关系取得局部点云,依据局部点云高度筛选当前待拆层并输出三维抓取位置及朝向;所述拆垛机器人在接近抓取位置时开启吸附,在负压传感器输出吸附到位信号后提升料包并通过压板抵压,在放料位置解除压板抵压并使吸附抓具进气释放。

16、优选地,还包括车辆检测装置,所述车辆检测装置获取车辆三维点云,所述控制器通过空间标志点建立车辆检测装置与装车机器人的坐标对应关系,确定车厢位置、尺寸及拉筋障碍区域,在机器人有效作业空间内生成避让障碍区域的装载点位;对于车厢前部已有物料且待装区域位于其后方的情况,以已装物料朝向待装区域一侧的最外缘所在断面作为装载起始断面,在该断面与车厢后边界之间生成剩余料包的装载点位。

17、本发明提供一种双通道袋装物料拆垛装车控制方法,应用于两个拆垛单元分别经独立启停且不合流的输送通道向对应停料装置供料、并共用一个装车机器人的系统;每个停料装置具有三个独立驱动且分别设有光电对射传感器和速度检测器的滚筒停料段,装车机器人的三个抓取段分别与三个滚筒停料段对应,抓取段的可张合爪齿能够伸入滚筒间隙,每个滚筒停料段的目标停放中心与对应抓取段的抓取中心相匹配;所述方法包括:

18、为两条通道分别建立包含停料段定位状态、送料事务占用状态和取料锁定状态的状态记录;在对应通道具有剩余送料任务、无未结束送料事务、未被取料锁定且存在输送路径为空的空停料段时,预约最下游的所述空停料段作为目标段,并在置位送料事务占用状态后向对应拆垛单元下发单包送料许可;

19、在料包前缘触发目标段传感器时,按照传感器位置减去料包前缘至抓取中心的标定距离确定估算中心位置,将目标停放中心至所述估算中心位置的距离扣除与料包配方和当前正向输送速度对应的停止响应位移,再除以所述输送速度得到停机等待时间;在该等待时间非负且配方、速度和停机时序处于标定有效范围时,按照该等待时间输出电机停止指令,确认电机停止且对应传感器持续检测到料包后记录目标段定位完成,并结束该送料事务,其中停止响应位移为停止指令输出至料包停止期间的料包移动距离;

20、在对应停料装置的三个停料段均定位完成且无未结束送料事务时,记录满料状态及当前批次首次满料时刻,将该批次记为就绪并暂停该通道供料;装车机器人空闲时,在具有就绪批次、未取料锁定、物料种类符合当前装载任务且具有可执行搬运任务的停料装置中选择取料来源,只有一个符合条件时选择该停料装置,两个均符合条件且等待时长之差的绝对值超过预设时差阈值时选择等待较长者,否则选择从当前位姿完成该批次取料、装载和返回待命位置的预计搬运时间较短者,预计时间相等时选择等待较长者,仍相等时按固定通道顺序选择;

21、锁定所选择的停料装置,控制与本批次已定位停料段对应的抓取段从该停料装置取料;确认机器人已离开该停料装置的取料干涉区域并且对应三个传感器均确认无料后,清除该停料装置的定位状态、满料状态、批次就绪状态和取料锁定状态,重新按剩余任务判断该通道送料许可,同时由装车机器人继续执行该批次的搬运及放置;机器人完成该批次全部装载并空载返回待命位置后,再选择下一取料来源。

22、本发明在下发送料许可前预约目标段并占用送料事务,将在途料包纳入通道状态管理,降低超供和相互干涉风险;根据料包参考前缘、输送速度及停止响应位移确定停机时刻,在标定工况及误差界限内使停放位置满足抓取要求;以批次等待时长和预计搬运时间选择共享机器人的取料来源,兼顾通道等待和机器人占用时间;在搬离及无料确认后恢复对应通道集料,使下一批供料与本批装载衔接。