一种采用双位置闭环控制系统的堆栈机的制作方法
【技术领域】
[0001]本发明涉及堆栈机技术领域，尤其涉及一种采用双位置闭环控制系统的堆栈机。
【背景技术】
[0002]堆栈机是自动化立体仓库的核心设备，通过在立体仓库中做X、Y、Z方向的三维运动以实现取送货物的功能。主要分为单立柱堆垛机和双立柱堆垛机，由行走、提升和货叉三个驱动机构完成作业要求。
[0003]现有的洁净堆栈机位置控制系统是半闭环控制系统，当堆栈机较重量较轻时，暴露出如下缺点:由于车轮会与轨道之间出现打滑现象，由于打滑是随机发生的，造成堆栈机位置控制系统控制精度无法预测，会出现堆栈机X、Z轴欠定位现象，轻则堆栈机报警停车，重则发生存储碰撞，撞坏存储货物。
[0004]另外，现有的洁净堆栈机板卡间通信多采用CAN总线连接在一起，通讯速率最高只有40M/lMbp/s，网络节点数实际可达110个，接插件、线缆不常见，没有形成统一的规格。洁净堆栈机是AMHS (自动物料搬运系统)的中枢环节，堆栈机运行的快慢直接关系到AMHS系统的节拍，从AMHS系统来讲，要求堆栈机的搬运速度尽可能的快，这就要求板卡间通信速率尽可能的高，如果板卡间同信速率无法满足堆栈机高速运动的数据交互速率，就会造成系统工作不稳定，轻则造成定位不准确，重则造成堆栈机无法停止，超程碰撞。洁净STOCKER (即洁净堆栈机)中有成百上千个货位，每个货位有3个检测FOUP (晶圆传送盒)是否正确放置的传感器，这些传感器最终要通过总线连接在一起，除了这些传感器以外，还有堆栈机多个限位传感器，控制柜的若干个板卡，手动、自动载入口的气缸，安全门，光幕灯这些信号的汇总都需要CAN节点，在实际使用中CAN总线节点数量捉襟见肘，往往刚刚满足需求，没有再给未来的系统扩充留有余量。洁净STOCKER中由于需要集中成百上千个节点，这些节点分布的非常广泛，需要大量的接插件与总线线缆，这些CAN线由于没有统一的标准，只能自己用屏蔽双绞线缆制作，接插件的规格也没有定论，接插件往往五花八门，这中没有统一标准的布线给工厂的后期保养造成了很大的困难，这些非标的线缆、接插件工厂往往没有库存，需要从线缆、接插件厂家定制，不仅给保养工作增添了成本与负担，还有可能因为等待线缆与接插件耽误整个AMHS系统的运行，这给高成本建厂和更新迅速的半导体工厂来说，无疑是致命的。
[0005]有鉴于此，现有技术有待改进和提高。
【发明内容】
[0006]鉴于现有技术的不足，本发明目的在于提供一种采用双位置闭环控制系统的堆栈机，以解决现有技术的采用半闭环控制系统的洁净堆栈机由于打滑是随机发生的，造成堆栈机位置控制系统控制精度无法预测的问题。
[0007]本发明的技术方案如下:
[0008]一种采用双位置闭环控制系统的堆栈机，其中，包括:主控系统和执行系统；
[0009]其中，所述主控系统进一步包括:第一光通信模块、主控制器、远程输入输出装置、传感器和外设装置；所述第一光通信模块连接主控制器，所述主控制器通过远程输入输出装置连接传感器和外设装置；
[0010]所述执行系统进一步包括:第二光通信模块、示教盒、机器人控制器、若干个位控板、行走轴电机驱动器、提升轴电机驱动器、货叉轴电机驱动器、旋转轴电机驱动器、行走轴磁栅和提升轴磁栅；所述第二光通信模块、示教盒分别与机器人控制器连接；所述机器人控制器通过若干个位控板连接所述行走轴电机驱动器、提升轴电机驱动器、货叉轴电机驱动器和旋转轴电机驱动器；所述行走轴磁栅、提升轴磁栅分别连接机器人控制器；
[0011 ] 所述第一光通信模块与第二光通信模块之间进行光通信。
[0012]所述的采用双位置闭环控制系统的堆栈机，其中，所述主控制器包括一 MCS单片机和与所述MCS单片机相连的PC ;其中，所述PC进一步包括一触摸屏；所述外设装置包括灯及按钮。
[0013]所述的采用双位置闭环控制系统的堆栈机，其中，所述主控制器通过RS232端口连接第一光通信模块；主控制器通过工业以太网连接所述远程输入输出装置。
[0014]所述的采用双位置闭环控制系统的堆栈机，其中，所述位控板的个数为两个，其包括第一位控板和第二位控板；所述第一位控板分别连接行走轴电机驱动器和提升轴电机驱动器，所述第二位控板分别连接提升轴电机驱动器和货叉轴电机驱动器。
[0015]所述的采用双位置闭环控制系统的堆栈机，其中，所述第一位控板、第二位控板与机器人控制器的连接采用EtherCAT接口。
[0016]所述的采用双位置闭环控制系统的堆栈机，其中，所述行走轴磁栅、提升轴磁栅与机器人控制器的连接采用EtherCAT接口。
[0017]所述的采用双位置闭环控制系统的堆栈机，其中，所述第二光通信模块与机器人控制器的连接通过RS232端口连接。
[0018]有益效果:本发明提供的一种采用双位置闭环控制系统的堆栈机，易于扩展，如机器人视觉系统等。另外，通过双位置闭环控制系统实现洁净堆栈机的高速运行，且减小位置超调。其中，内位置环的存在降低了对外位置环的控制周期要求。另外，由于有外部磁栅定位的存在，消除了累计误差，避免了繁琐的定期示教作业，具有很好的市场推广应用前景。
【附图说明】
[0019]图1为本发明的采用双位置闭环控制系统的堆栈机的较佳实施例的示意图。
[0020]图2为本发明的采用双位置闭环控制系统的堆栈机的较佳实施例中行走、提升轴的控制框图。
【具体实施方式】
[0021]为使本发明的目的、技术方案及优点更加清楚、明确，以下参照附图并举实施例对本发明进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
[0022]请参阅图1，其为本发明的采用双位置闭环控制系统的堆栈机的较佳实施例的示意图。如图所示，所述采用双位置闭环控制系统的堆栈机包括:主控系统和执行系统(图中未示出)；其中，所述主控系统进一步包括:第一光通信模块、主控制器、远程输入输出装置(图中用远程1表示)、传感器和外设装置；所述第一光通信模块连接主控制器，所述主控制器通过远程输入输出装置连接传感器和外设装置；所述执行系统进一步包括:第二光通信模块、示教盒、机器人控制器(图中用RC表示)、若干个位控板、行走轴电机驱动器、提升轴电机驱动器、货叉轴电机驱动器、旋转轴电机驱动器、行走轴磁栅和提升轴磁栅；所述第二光通信模块、示教盒分别与机器人控制器连接；所述机器人控制器通过若干个位控板连接所述行走轴电机驱动器、提升轴电机驱动器、货叉轴电机驱动器和旋转轴电机驱动器；所述行走轴磁栅、提升轴磁栅分别连接机器人控制器；所述第一光通信模块与第二光通信模块之间进行光通信。
[0023]所述主控系统用于接收用户的输入指令，同时根据传感器输入的信号来控制执行系统进行相应的操作。所述第一光通信模块与第二光通信模块将主控系统和执行系统连接起来(通过光通信连接)。在本实施例中，所述主控制器包括一 MCS单片机和与所述MCS单片机相连的PC (图中用MCS PC表示)；其中，所述PC进一步连接一触摸屏；所述外设装置包括灯及按钮。另外，所述主控制器通过RS232端口连接第一光通信模块；主控制器通过工业以太网连接所述远程输入输出装置。RS-232是PC机与通信工业中应用最广泛的一种串行接口。RS-232被定义为一种在低速率串行通讯中增加通讯距离的单端标准。RS-232是为点对点(即只用一对收、发设备)通讯而设计的，其驱动器负载为3?7kQ。所以RS-232适合本地设备之间的通信。
[0024]所述执行系统是发明的关键，一般来说，洁净堆栈机在运行过程中由于驱动轮与轨道间会发生打滑现象，如果靠电机的位置闭环实现定位，就变成了一个开环系统。而本发明则增加两个外部磁栅