[发明专利]一种采用双位置闭环控制系统的堆栈机

说明书

技术领域

本发明涉及堆栈机技术领域，尤其涉及一种采用双位置闭环控制系统的堆栈机。

背景技术

堆栈机是自动化立体仓库的核心设备，通过在立体仓库中做X、Y、Z方向的三维运动以实现取送货物的功能。主要分为单立柱堆垛机和双立柱堆垛机，由行走、提升和货叉三个驱动机构完成作业要求。

现有的洁净堆栈机位置控制系统是半闭环控制系统，当堆栈机较重量较轻时，暴露出如下缺点：由于车轮会与轨道之间出现打滑现象，由于打滑是随机发生的，造成堆栈机位置控制系统控制精度无法预测，会出现堆栈机X﹑Z轴欠定位现象，轻则堆栈机报警停车，重则发生存储碰撞，撞坏存储货物。

另外，现有的洁净堆栈机板卡间通信多采用CAN总线连接在一起，通讯速率最高只有40M/1Mbp/s，网络节点数实际可达110个，接插件﹑线缆不常见，没有形成统一的规格。洁净堆栈机是AMHS（自动物料搬运系统）的中枢环节，堆栈机运行的快慢直接关系到AMHS系统的节拍，从AMHS系统来讲，要求堆栈机的搬运速度尽可能的快，这就要求板卡间通信速率尽可能的高，如果板卡间同信速率无法满足堆栈机高速运动的数据交互速率，就会造成系统工作不稳定，轻则造成定位不准确，重则造成堆栈机无法停止，超程碰撞。洁净STOCKER（即洁净堆栈机）中有成百上千个货位，每个货位有3个检测FOUP（晶圆传送盒）是否正确放置的传感器，这些传感器最终要通过总线连接在一起，除了这些传感器以外，还有堆栈机多个限位传感器，控制柜的若干个板卡，手动﹑自动载入口的气缸，安全门，光幕灯这些信号的汇总都需要CAN节点，在实际使用中CAN总线节点数量捉襟见肘，往往刚刚满足需求，没有再给未来的系统扩充留有余量。洁净STOCKER中由于需要集中成百上千个节点，这些节点分布的非常广泛，需要大量的接插件与总线线缆，这些CAN线由于没有统一的标准，只能自己用屏蔽双绞线缆制作，接插件的规格也没有定论，接插件往往五花八门，这中没有统一标准的布线给工厂的后期保养造成了很大的困难，这些非标的线缆﹑接插件工厂往往没有库存，需要从线缆﹑接插件厂家定制，不仅给保养工作增添了成本与负担，还有可能因为等待线缆与接插件耽误整个AMHS系统的运行，这给高成本建厂和更新迅速的半导体工厂来说，无疑是致命的。

有鉴于此，现有技术有待改进和提高。

发明内容

鉴于现有技术的不足，本发明目的在于提供一种采用双位置闭环控制系统的堆栈机，以解决现有技术的采用半闭环控制系统的洁净堆栈机由于打滑是随机发生的，造成堆栈机位置控制系统控制精度无法预测的问题。

本发明的技术方案如下：

一种采用双位置闭环控制系统的堆栈机，其中，包括：主控系统和执行系统；

其中，所述主控系统进一步包括：第一光通信模块、主控制器、远程输入输出装置、传感器和外设装置；所述第一光通信模块连接主控制器，所述主控制器通过远程输入输出装置连接传感器和外设装置；

所述执行系统进一步包括：第二光通信模块、示教盒、机器人控制器、若干个位控板、行走轴电机驱动器、提升轴电机驱动器、货叉轴电机驱动器、旋转轴电机驱动器、行走轴磁栅和提升轴磁栅；所述第二光通信模块、示教盒分别与机器人控制器连接；所述机器人控制器通过若干个位控板连接所述行走轴电机驱动器、提升轴电机驱动器、货叉轴电机驱动器和旋转轴电机驱动器；所述行走轴磁栅、提升轴磁栅分别连接机器人控制器；

所述第一光通信模块与第二光通信模块之间进行光通信。

所述的采用双位置闭环控制系统的堆栈机，其中，所述主控制器包括一MCS单片机和与所述MCS单片机相连的PC；其中，所述PC进一步包括一触摸屏；所述外设装置包括灯及按钮。

所述的采用双位置闭环控制系统的堆栈机，其中，所述主控制器通过RS232端口连接第一光通信模块；主控制器通过工业以太网连接所述远程输入输出装置。

所述的采用双位置闭环控制系统的堆栈机，其中，所述位控板的个数为两个，其包括第一位控板和第二位控板；所述第一位控板分别连接行走轴电机驱动器和提升轴电机驱动器，所述第二位控板分别连接提升轴电机驱动器和货叉轴电机驱动器。

所述的采用双位置闭环控制系统的堆栈机，其中，所述第一位控板、第二位控板与机器人控制器的连接采用EtherCAT接口。

所述的采用双位置闭环控制系统的堆栈机，其中，所述行走轴磁栅、提升轴磁栅与机器人控制器的连接采用EtherCAT接口。