[实用新型]自动装卸自动导引车辆控制系统

说明书

技术领域

本实用新型是有关于自动导引车辆（AGV，Automated Guided Vehicle）技术领域，且特别是有关于一种自动装卸自动导引车辆控制系统。

背景技术

自动导引车辆(Automated Guided Vehicle，简称AGV)，指装备有电磁或光学等自动导引装置，能够沿规定的导引路径行驶，具有安全保护以及各种移载功能的运输车，工业应用中不需驾驶员且以可充电之蓄电池为其动力来源。一般可透过电脑来控制其行进路线以及行为，或利用电磁轨道来设立其行进路线，电磁轨道黏贴于地板上，无人搬运车则依循电磁轨道所带来的信息进行移动与动作。 

AGV相对于步行、爬行或其它非轮式的移动机器人具有行动快捷、工作效率高、结构简单、可控性强、安全性好等优势。与物料输送中常用的其他设备相比，AGV的活动区域无需铺设轨道、支座架等固定装置，不受场地、道路和空间的限制。

一般普通的AGV都具有两个电机驱动其运动，由这两个电机分别控制其在平面上的X坐标和Y坐标，并有一个万向轮来调节其稳定性，到达站点后人工装卸货物。现有的AGV基本上都是由单个数字信号处理器（digital signal processor，DSP）控制，如图1所示，为现有技术的AGV控制系统的方框图。

现有技术中，一般的AGV的控制系统包括电池11、DSP 12、第一控制器13、第二控制器14、第一电机15、第二电机16、信号处理器17及机械装置18。电池11为供电装置，为整个系统的工作提供工作电压。DSP12内置控制程序，并发出控制信号至第一控制器13及第二控制器14，第一控制器13及第二控制器14分别控制第一电机15、第二电机16的工作，第一电机15、第二电机16又分别用于驱动设于AGV的机械装置18进行运动。其中，第一电机15和第二电机16的驱动信号经过信号处理器17合成之后，控制机械装置18的运动。

长期以来，发现传统的AGV存在着很多安全隐患，包括：

（1）由于人工的加入，并未实现真正的自动化，而且人为因素也加重了AGV小车故障率。

（2）由于多轴联动的工作量很大，单片DSP一般情况下会舍弃考虑电池的状态，使得系统能源得不到最优利用。

（3）单片DSP难以胜任多信号处理系统的要求，如果增加新的处理器来满足AGV快速性和稳定性的要求，又要处理两个处理器之间的同步和通讯等问题，延长了系统开发时间。

（4）由于受周围环境不稳定因素干扰，单DSP控制器经常会出现异常，引起失控，抗干扰能力较差。

因此，需要对现有的基于单片DSP控制的AGV控制器进行重新设计。

实用新型内容

针对上述问题，本实用新型的目的是提供一种自动装卸自动导引车辆控制系统，其有ADSP及FPGA双核控制，且包括自动装载电机，实现自动导引车辆的全自动化装载和卸载货物。

本实用新型提出一种自动装卸自动导引车辆控制系统，其包括电池、控制模块、电机控制器、第一电机、第二电机、信号处理器及机械装置，其特征在于：该系统进一步包括第三电机，控制模块发出控制信号至电机控制器，电机控制器分别控制第一电机、第二电机和第三电机的工作，第一电机和第二电机驱动机械装置运动；第三电机为自动装载电机；第一电机、第二电机和第三电机的驱动信号经过信号处理器合成之后，控制机械装置的运动；在等待时间，电池自动充电。控制模块为一双核控制器，其包括设于ADSP电路及FPGA电路的上位机系统和运动控制系统，其中，上位机系统包括人机界面、路径规划模块及在线输出模块；运动控制系统包括编码器模块、输入输出控制模块、数据存储模块及伺服控制模块，其中，ADSP电路实现人机界面、路径规划模块、数据存储模块、输入输出控制模块、在线输出模块，FPGA电路实现伺服控制模块。

在本实用新型的一个实施例中，所述电池进一步与第一电机、第二电机和第三电机的输出端连接，且控制模块进一步分别连接至第一电机输出端和电池之间的连接点，第二电机输出端和电池之间的连接点，及第三电机输出端和电池之间的连接点。

在本实用新型的一个实施例中，所述人机界面包括开始/重启按键及功能选择键。

在本实用新型的一个实施例中，所述编码器模块检测自动导引车辆实际转速，判断是否符合速度要求，是否过快或过慢，并发出控制信号。

在本实用新型的一个实施例中，所述伺服控制模块包括数字模拟模块、传感器模块、电流模块、速度模块及位移模块。