CN102830706A - 医用agv控制系统 - Google Patents
医用agv控制系统 Download PDFInfo
- Publication number
- CN102830706A CN102830706A CN2012103533066A CN201210353306A CN102830706A CN 102830706 A CN102830706 A CN 102830706A CN 2012103533066 A CN2012103533066 A CN 2012103533066A CN 201210353306 A CN201210353306 A CN 201210353306A CN 102830706 A CN102830706 A CN 102830706A
- Authority
- CN
- China
- Prior art keywords
- module
- agv
- processor
- motor
- control system
- 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.)
- Granted
Links
- 238000004891 communication Methods 0.000 claims description 16
- 238000006073 displacement reaction Methods 0.000 claims description 13
- 238000013439 planning Methods 0.000 claims description 12
- 230000009977 dual effect Effects 0.000 claims description 6
- 238000001514 detection method Methods 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 claims description 3
- 230000006870 function Effects 0.000 description 16
- 239000000463 material Substances 0.000 description 15
- 238000000034 method Methods 0.000 description 13
- 230000004888 barrier function Effects 0.000 description 12
- 238000013461 design Methods 0.000 description 11
- 230000008569 process Effects 0.000 description 11
- 230000005540 biological transmission Effects 0.000 description 9
- 238000012545 processing Methods 0.000 description 7
- 239000003814 drug Substances 0.000 description 5
- 230000004044 response Effects 0.000 description 5
- 238000004519 manufacturing process Methods 0.000 description 4
- 239000002253 acid Substances 0.000 description 3
- 230000009471 action Effects 0.000 description 3
- 229940079593 drug Drugs 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000002347 injection Methods 0.000 description 3
- 239000007924 injection Substances 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 238000007726 management method Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000009415 formwork Methods 0.000 description 2
- 238000007689 inspection Methods 0.000 description 2
- 238000012384 transportation and delivery Methods 0.000 description 2
- 230000001960 triggered effect Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000008571 general function Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000035800 maturation Effects 0.000 description 1
- 230000006386 memory function Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000004321 preservation Methods 0.000 description 1
- 239000000243 solution Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种医用AGV控制系统，包括处理器单元、控制器、第一电机、第二电机、信号处理器、AGV小车、物流进/出站以及物流总站，所述的控制器分别与物流进/出站和物流总站通讯，所述的处理器单元发出控制信号至所述控制器，通过所述的控制器把控制信号分为第一驱动信号和第二驱动信号，所述的第一驱动信号和第二驱动信号分别控制所述的第二电机和第一电机，其中，通过所述的第一电机的第二驱动信号和通过所述的第二电机的第一驱动信号经过信号处理器合成之后，控制AGV小车的运动。本发明提供一种医用AGV控制系统，解决了现有技术中AGV小车失控的现象以及抗干扰能力差的问题。
Description
技术领域
本发明是有关于自动导引车辆（AGV，Automated Guided Vehicle）技术领域，且特别是有关于医用AGV控制系统。
背景技术
医院物流传输系统的应用是医院现代化的重要标志之一。目前医院的物流传输系统主要包括医用气动物流传输系统、轨道式物流传输系统和高空的单轨推车传输系统等。
AGV物流控制系统相对于气动物流传输系统、轨道式物流传输系统和高空的单轨推车传输系统等具有行动快捷、工作效率高、结构简单、可控性强、安全性好等优势。与物料输送中常用的其他设备相比，AGV小车的活动区域无需铺设轨道、支座架等固定装置，不受场地、道路和空间的限制。
一般医院AGV物流控制系统中使用的AGV小车普遍都是由左右两个电机驱动通过不同的速度组合驱动其运动，通过控制两个电机来获取其在平面上的X坐标和Y坐标，形成差速控制，并有一个万向轮或多个万向轮来调节其稳定性，到达取货点后由人工装卸药物。
现有的医用AGV控制系统基本上都是由单个数字信号处理器（digital signal processor，DSP）控制，形成四轮差速转向行驶，如图1所示，为现有技术的AGV控制系统的方框图。
现有技术中，一般的医用AGV控制系统包括电池、DSP处理器、第一控制器、第二控制器、第一电机、第二电机、信号处理器及AGV小车。电池为供电装置，为整个系统的工作提供工作电压。DSP处理器内置控制系统，并发出控制信号至第一控制器及第二控制器，第一控制器和第二控制器分别控制第二电机和第一电机的工作，第一电机和第二电机又分别用于驱动AGV小车进行运动。其中，第一电机和第二电机的驱动信号经过信号处理器合成之后，控制AGV小车的运动。
长时间运行发现现有技术中的医用AGV控制系统存在着很多安全隐患，包括：
（1）由于AGV小车频繁的刹车和启动，加重了DSP处理器的工作量，单片的DSP处理器无法考虑电池的荷电状态，加重了电池的老化；
（2）现有的AGV小车都没有考虑AGV小车的脉动转矩，使得AGV小车小车有时候特别是遇到复杂路径时抖动非常厉害，影响了一些贵重药物的运送；
（3）由于受周围环境不稳定因素干扰，单片的DSP处理器抗干扰能力较差，经常会出现异常，并引起AGV小车失控；
（4）现有的医用AGV控制系统不可以实现在工作站之间自动对物料的跟踪，也不能对输送进行确认，也没有输送物料的执行检查记录，不能与库存管理系统之间进行实时信息沟通；
（5）现有的医用AGV控制系统操作人员需为跟踪物料而进行大量的报表工作，因而不利于提高劳动生产率；
（6）现有的医用AGV控制系统运输物料都是沿着某一个固定方向和固定站点进行运送货物，当遇到紧急情况时还需要人为干预，经常会产生药品或生产设备的损坏。
因此，需要对现有的基于单片DSP处理器控制的AGV物流控制系统进行重新设计。
发明内容
针对上述问题，本发明的目的是提供一种医用AGV控制系统，解决了现有技术中AGV小车失控的现象以及抗干扰能力差的问题。
为解决上述技术问题，本发明采用的一个技术方案是：提供一种医用AGV控制系统，包括处理器单元、控制器、第一电机、第二电机、信号处理器、AGV小车、物流进/出站以及物流总站，所述的控制器分别与物流进/出站和物流总站通讯，所述的处理器单元发出控制信号至所述控制器，通过所述的控制器把控制信号分为第一驱动信号和第二驱动信号，所述的第一驱动信号和第二驱动信号分别控制所述的第二电机和第一电机，其中，通过所述的第一电机的第二驱动信号和通过所述的第二电机的第一驱动信号经过信号处理器合成之后，控制AGV小车的运动。
在本发明一个较佳实施例中，所述的处理器单元为一双核处理器，包括DSP处理器、FPGA处理器以及设于DSP处理器和FPGA处理器的上位机系统和运动控制系统，所述的所述的上位机系统包括人机界面模块、路径规划模块以及在线输出模块，所述的运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块，其中，DSP处理器用于控制人机界面模块、路径规划模块、在线输出模块、数据存储模块以及I/O控制模块，FPGA处理器用于控制伺服控制模块，且DSP处理器及FPGA处理器之间实时进行数据交换和调用。
在本发明一个较佳实施例中，所述的人工装卸控制系统还包括电池，所述电池进一步与第一电机和第二电机的输出端连接，且处理器单元进一步连接至第二电机输出端和电池之间的连接点。
在本发明一个较佳实施例中，所述的伺服控制模块还包括转换模块，所述的转换模块包括模拟数字转换器及数字模拟转换器。
在本发明一个较佳实施例中，所述的伺服控制模块还包括编码器模块，所述的编码器模块用于检测AGV小车实际转速，判断是否符合速度要求，是否过快或过慢，并发出控制信号。
在本发明一个较佳实施例中，所述的伺服控制模块还包括电流模块，所述的电流模块用于调整电池的供电功率达到AGV小车需要的范围。
在本发明一个较佳实施例中，所述的伺服控制模块还包括速度模块，所述的速度模块与编码器模块通讯连接，当编码器模块检测AGV小车实际转速过快或过慢，速度模块根据编码器模块检测的结果来调节AGV小车实际转速。
在本发明一个较佳实施例中，所述的伺服控制模块还包括位移模块，所述的位移模块用于检测AGV小车是否到站，是否到达既定位移，如果过慢，发出加速指令至控制器；如果离既定位移过近，需要减速，则发出减速指令至控制器。
在本发明一个较佳实施例中，所述的AGV小车包括导航正向传感器、导航反向传感器、前方壁障传感器、左右侧面壁障传感器、站点传感器和返回路径传感器，所述的导航正向传感器和导航反向传感器判断AGV小车是否在中线运行，并调整AGV小车在适当的运行位置。
本发明的医用AGV控制系统，为了提高运算速度，保证医用AGV控制系统的稳定性和可靠性，本发明在处理器单元的DSP处理器中引入FPGA处理器，形成基于DSP+FPGA的双核处理器，此处理器单元把原有单片的DSP处理器实现的多控制器系统集中设计，并充分考虑电池在这个系统的作用，实现同步控制AGV小车X、Y轴的功能，把医用AGV控制系统中工作量最大的伺服控制模块以及多个AGV小车之间的数据通讯交给FPGA处理器处理，充分发挥FPGA处理器数据处理速度较快和不怕干扰的的特点，而人机界面模块、路径规划模块、在线输出模块、数据存储模块、I/O控制模块等功能交给DSP处理器控制，这样就实现了DSP处理器与FPGA处理器的分工，把DSP处理器从繁重的工作量中解脱出来，有效地防止AGV小车失控现象的产生，抗干扰能力大大增强。
附图说明
图1为现有技术的医用AGV物流AGV控制系统的方框图；
图2为本发明较佳实施例的医用AGV控制系统的方框图；
图3为图2中处理器单元的方框图；
图4为本发明较佳实施例的医用AGV控制系统的应用示意图。
具体实施方式
下面结合附图对本发明的较佳实施例进行详细阐述，以使本发明的优点和特征能更易于被本领域技术人员理解，从而对本发明的保护范围做出更为清楚明确的界定。
随着微电子技术和计算机集成芯片制造技术的不断发展和成熟，DSP处理器由于其快速的计算能力，不仅广泛应用于通信与视频信号处理，也逐渐应用在各种高级的控制系统中。AD公司的ADSP-21xx系列提供了低成本、低功耗、高性能的处理能力和解决方案，其中的ADSP-2188指令执行速度高达75MIPS，加上独立的算术逻辑单元，拥有强大的数字信号处理能力。此外，大容量的RAM被集成到该芯片内，可以极大地简化外围电路设计，降低系统成本和系统复杂度，也大大提高了数据的存储处理能力。
基于现场可编程门阵列的FPGA处理器及现代电子设计自动化的EDA技术的硬件实现方法是最近几年出现了一种全新的设计思想。虽然FPGA处理器本身只是标准的单元阵列，没有一般的集成电路所具有的功能，但用户可以根据自己的设计需要，通过特定的布局布线工具对其内部进行重新组合连接，在最短的时间内设计出自己的专用集成电路，这样就减小成本、缩短开发周期。由于FPGA处理器采用软件化的设计思想实现硬件电路的设计，这样就使得基于FPGA处理器设计的系统具有良好的可复用和修改性，这种全新的设计思想已经逐渐应用在高性能的交流驱动控制上，并快速发展。
如图2所示，为本发明较佳实施例的医用AGV控制系统的方框图。本实施例中，医用AGV控制系统包括电池、处理器单元、控制器、第一电机、第二电机、信号处理器、AGV小车、物流进/出站以及物流总站，所述的控制器分别与物流进/出站和物流总站通讯。其中，所述电池为铅酸电池，是一种供电装置，为整个系统的工作提供工作电压。电池进一步与第一电机和第二电机的输出端连接，且处理器单元进一步分别连接至第一电机输出端和电池之间的连接点以及第二电机输出端和电池之间的连接点。
本发明中所述的处理器单元内置控制系统及控制电路，所述的处理器单元发出控制信号至所述的控制器，所述的处理器单元发出控制信号至所述控制器，通过所述的控制器把控制信号分为第一驱动信号和第二驱动信号，所述的第一驱动信号和第二驱动信号分别控制所述的第二电机和第一电机，其中，通过所述的第一电机的第二驱动信号和通过所述的第二电机的第一驱动信号经过信号处理器合成之后，控制AGV小车的运动。
本发明为克服现有技术中单片的DSP处理器不能满足医用AGV控制系统的稳定性和快速性的要求，舍弃了医用AGV控制系统所采用单片的DSP处理器的工作模式，提供了基于DSP+FPGA处理器的全新控制模式。处理器单元以FPGA处理器为处理核心，实现数字信号的实时处理，把DSP处理器从复杂的工作当中解脱出来，实现部分的信号处理算法和FPGA处理器的控制逻辑，并响应中断，实现数据通信和存储实时信号。
请参阅图3，所述处理器单元为一双核处理器，其包括DSP处理器及FPGA处理器，二者可相互通讯，实时进行数据交换和调用。所述的处理器单元还包括设于DSP处理器以及FPGA处理器的上位机系统和运动控制系统，所述上位机系统包括人机界面模块、路径规划模块以及在线输出模块，所述运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块，其中，DSP处理器用于控制人机界面模块、路径规划模块、在线输出模块、数据存储模块以及I/O控制模块，FPGA处理器用于控制伺服控制模块。
上位机系统包括人机界面模块、路径规划模块以及在线输出模块。人机界面模块包括开始/重启按键及功能选择键；路径规划模块包括已经预设好的速度，加速度，位置等参数设置；在线输出模块用于提示AGV小车的工作状态，比如是AGV小车工作过程中或到站状态提示。
运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块。其中，数据存储模块模块为一存储器；I/O控制模块包括RS-232串行接口、ICE端口等。伺服控制模块进一步包括转换模块、编码器模块、电流模块、速度模块以及位移模块。
其中，所述转换模块包括模拟数字转换器（ADC，Analog to Digital Converter）及数字模拟转换器（DAC，Digital to Analog Converter）；所述编码器模块用于检测AGV小车实际转速，判断是否符合速度要求，是否过快或过慢，并发出控制信号。
所述电流模块与电池和控制器、转换模块连接。转换模块根据电池和控制器的电流，判断工作功率，并把功率状况反馈至电池，电流模块用于调整电池的供电功率达到AGV小车需要的范围。
所述速度模块与编码器模块通讯连接，当编码器模块检测AGV小车实际转速过快或过慢，速度模块根据编码器模块检测的结果来调节AGV小车实际转速。
所述位移模块检测AGV小车是否到站，是否到达既定位移，如果过慢，发出加速指令至控制器；如果离既定位移过近，需要减速，则发出减速指令至控制器。
对于处理器单元为一双核处理器，在电源打开状态下，先由人机界面模块工作，再根据人机界面模块的功能选择确定AGV小车的路径规划模块，AGV小车的导航传感器、前方壁障传感器、左右侧面壁障传感器根据实际导航环境传输参数给处理器单元中的DSP处理器，DSP处理器处理后与FPGA处理器通讯，然后由FPGA处理器处理两个电机的伺服控制模块并把处理后的数据通讯给DSP处理器，由DSP处理器继续处理后续的运行状态。AGV小车到达站点后，由人工读取货物的条形码，然后在线存储并通知总站生成各种报表。
结合以上描述，上位机系统包括人机界面模块、路径规划模块、在线输出模块等功能；运动控制系统包括伺服控制模块、数据存储模块、I/O控制模块等功能，其中工作量最大的伺服控制模块交给FPGA处理器控制，其余的包括上位机系统交给DSP处理器控制，这样就实现了DSP处理器与FPGA处理器的分工，同时二者之间也可以进行通讯，实时进行数据交换和调用。
本发明中的AGV小车包括一个驱动轮、两个从动轮、多个传感器以及防撞装置，所述从动轮上均安装有光码盘。其中，所述的AGV小车包括导航正向传感器、导航反向传感器、前方壁障传感器、左右侧面壁障传感器、站点传感器和返回路径传感器，所述的导航正向传感器和导航反向传感器判断AGV小车是否在中线运行，并调整AGV小车在适当的运行位置。
如图4所示，本实施例中，包括标号S1、S2、S3、S4、S5、S6、S7、S8、S9、S10、S11、S12、S13、S14、S15、S18、S19和S20代表的传感器，其设于AGV小车的不同部位，其中，传感器S1、S2、S3、S4和S5为导航正向传感器，判断AGV小车是否在中线运行，调整AGV小车在适当的运行位置；传感器S9、S10 、S19和S20为设于AGV小车前方的前方壁障传感器和传感器S8和S18为设于AGV小车侧面的侧面壁障传感器；设于AGV小车的传感器S6为站点传感器，S7为返回路径传感器，其用于实现位移模块的功能；传感器S11、S12、S13、S14和S15为导航反向传感器，用于调换第一电机和第二电机的运动方向。图中的站点1~n、和充电区域是设于地面的反射装置，上述传感器可配合反射装置协助AGV小车的运动。
其具体的功能实现如下：
1）在AGV小车未接到命令之前，它一般会在充电区域等待控制器发出的命令，一旦接到任务后，会沿着充电区域边上的轨道进入货物运送轨道。
3）AGV小车进入轨道后，如果进入正常运货状态时，其前方的传感器组1将工作，前方壁障传感器S9、S10和侧面壁障传感器S8会对周围环境进行判断，确定有没有障碍物进入运行范围，如存在障碍物将向DSP处理器发出中断请求，DSP处理器会对中断做第一时间响应，如果DSP处理器的中断响应没有来得及处理，AGV小车上的防撞装置将被触发，进而达到蔽障的功能，如果没有障碍物进入运行范围，AGV小车将进行正常的状态运行；在AGV小车进入轨道正常运行时，其导航正向传感器S1、S2、S3、S4和S5将工作，并把反射回来的光电信号送给DSP处理器，经DSP处理器判断后送给FPGA处理器，由FPGA处理器运算后与DSP处理器进行通讯，然后由控制器送第一驱动信号和第二驱动信号分别给直线导航的第二电机和第一电机进行差动伺服控制；
4）当AGV小车在正常状态运行时，如果接到返回某一经过站点时，会自动原地停车，然后通过算法倒换马达的方向，然后传感器组2将工作，前方壁障传感器S19、S20和侧面壁障传感器S18会对周围环境进行判断，确定有没有障碍物进入运行范围，如存在障碍物将向DSP处理器发出中断请求，DSP处理器会对中断做第一时间响应，如果DSP处理器的中断响应没有来得及处理，AGV小车上的防撞装置将被触发，进而达到蔽障的功能，如果没有障碍物进入运行范围，AGV小车将进行正常的返回状态运行，在AGV小车进入轨道正常运行时，其导航反向传感器S11、S12、S13、S14和S15将工作，并把反射回来的光电信号送给DSP处理器，经DSP处理器判断后送给FPGA处理器，由FPGA处理器运算后与ADSP处理器进行通讯， 然后由控制器送第一驱动信号和第二驱动信号分别给直线导航的第二电机和第一电机进行差动伺服控制，在返回过程中如果读到站点将自动减1并保存；
5）系统加入了返回路径传感器S7，当电池低压时，控制器会开启此传感器，当传感器S7读取地面上的返回条码，然后送给控制器，控制器根据此信号进行运算后，控制第一电机和第二电机的运行速度，使AGV小车沿着设定路径返回，然后进入充电区域，并自动充电；
6）为了能够实现AGV小车的稳定运转，减少电机的脉动转矩，控制器在考虑电机特性的基础上加入了对电机转矩的在线辨识，并利用电机力矩与电流的关系进行补偿，减少了电机转矩抖动对一些贵重药品的影响；
7）为了能够实现AGV小车的站点功能，本发明加入了站点传感器S6，此传感器会对地面上的站点条码进行读取，并自动累加，到达站点后会自动停车，由当前站点的工人自动装卸货物；
8）为了实现循环功能，当AGV小车达到最大站点n时控制器会发出自动清零信号，使站点从1开始重新计数；
9）到达到某一站点需要下载货物时，货物的条形码会被车载存储装置读取并与物流总站需要下载的料单进行对比并保存，如果信息正确货物将被下载，并通过无线装置把进站的货物发送给物流总站，这样物流总站可以轻易的读取各种报表以及对货物的追踪；
10）到达到某一站点需要上载货物时，货物的条形码会被车载存储装置读取并与物流总站需要装载的料单进行对比并保存，如果信息正确货物将被装载，并通过无线装置把出站的货物发送给物流总站，这样物流总站可以轻易的读取各种报表以及对货物的追踪；
11） AGV小车按固定路径行驶走时，如果导航正向传感器S1、S2、S3、S4、S5或者导航反向传感器S11、S12、S13、S14、S15都已经偏离了轨道，这个时候控制器会发出自锁信号，原地锁死马达，这样马达就不会继续运动，这样就不易与加工设备和其他障碍物碰撞，因此运输物料时，很少有产品或生产设备的损坏；
12：AGV小车按固定路径行驶走时，系统上的多种声光报警系统将工作，很轻易的探测到周围各种障碍物的存在，当有危险存在时，控制器会发出自动停车信号，并根据具体障碍物判断是不是自动再次启动，还是直接锁死在原地。
综上所述，本发明揭示的医用AGV控制系统，为了提高运算速度，保证医用AGV控制系统的稳定性和可靠性，本发明在处理器单元的DSP处理器中引入FPGA处理器，形成基于DSP+FPGA的双核处理器，此处理器单元把原有单片的DSP处理器实现的多控制器系统集中设计，并充分考虑电池在这个系统的作用，实现同步控制AGV小车X、Y轴的功能，把医用AGV控制系统中工作量最大的伺服控制模块以及多个AGV小车之间的数据通讯交给FPGA处理器处理，充分发挥FPGA处理器数据处理速度较快和不怕干扰的的特点，而人机界面模块、路径规划模块、在线输出模块、数据存储模块、I/O控制模块等功能交给DSP处理器控制，这样就实现了DSP处理器与FPGA处理器的分工，把DSP处理器从繁重的工作量中解脱出来，有效地防止AGV小车失控现象的产生，抗干扰能力大大增强。
本发明医用AGV控制系统具有的有益效果是：
1、在运动过程中，充分考虑了电池在这个系统中的作用，基于DSP+FPGA处理器时刻都在对AGV小车的运行状态和放电电流进行监测和运算，所以从根本上解决了大电流对电池的冲击，由于大电流放电而引起的铅酸电池过度老化现象的发生；
2、在快速放电过程中，对电池荷电状态SOC时刻检测，并引入了铅酸的内阻、温度等参数，使得SOC更接近于实际参数；
3：为了更好的保护电池，当系统遇到低压时，AGV小车上的传感器S7会自动开启，当读到充电路径返回条码时，AGVAGV会自动回到充电区域，然后自动充电，从根本上杜绝了电池低压带来的危险；
4：在AGV小车运行过程中，控制器会对电机的转矩进行在线辨识并利用电机力矩与电流的关系进行补偿，减少了电机转矩抖动对一些贵重药品的影响；
5：由FPGA处理器控制伺服控制模块，大大提高了运算速度，解决了单片的DSP处理器运行较慢的瓶颈，缩短了开发周期短，并且程序可移植能力强；
6：完全实现了单板控制，不仅节省了控制板占用空间，而且还完全实现了两路电机控制信号的同步，有利于提高AGV小车的稳定性和动态性能；
7：由于本控制器采用FPGA处理器处理大量的数据与算法，并充分考虑了周围的干扰源，并把DSP从繁重的工作量中解脱出来，有效地防止了系统的“飞轮”的现象产生，抗干扰能力大大增强；
8：本AGV小车加入了自动倒车功能，当遇到紧急情况需要倒车时，只要控制器收到倒车请求时，就可以在原地停车，然后通过算法倒换马达的运转方向，利用另外一组传感器进行导航，这样就可以直接回到刚刚离开的站点，并自动更新站点；
9：当AGV小车在弯道遇到紧急情况需要停车时，AGV小车会自动原地锁死马达，并记录下停车前的各种参数，当再次开启时，控制器会自动计算出在弯道上马达的速度，并按照一定比例慢慢加速，从根本上杜绝了AGV小车在弯道上做直道的动作；
10：改进系统具有存储功能，所以可以实现在工作站之间对物料进行跟踪，对输送进行确认；按计划输送物料并有执行检查记录，与库存管理系统进行在线连接并向管理系统提供实时信息；
11：由于人工检取与堆置物料的劳动力减少，操作人员无需为跟踪物料而进行大量的报表工作，因而显著提高劳动生产率，另外，非直接劳动力如物料仓库会计员、发料以及运货车调度员的工作减少甚至完全取消，这又进一步减低了成本；
12：改进AGV小车按固定路径行驶，并加入了自锁功能，当偏离轨道较多时，就会自动锁死马达，这样就不易与加工设备和其他障碍物碰撞，因此运输物料时，很少有产品或生产设备的损坏。
13：还可以装备多种声光报警系统，能通过车载障碍探侧系统，在碰撞到障碍物之前自动停车，并根据具体障碍物判断是不是自动再次启动，还是一直待在原地不动，这样就保证了在行走过程中对周围环境的适应，减少了环境对其的干扰。
以上所述仅为本发明的实施例，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。
Claims (9)
1.一种医用AGV控制系统，其特征在于，包括处理器单元、控制器、第一电机、第二电机、信号处理器、AGV小车、物流进/出站以及物流总站，所述的控制器分别与物流进/出站和物流总站通讯，所述的处理器单元发出控制信号至所述控制器，通过所述的控制器把控制信号分为第一驱动信号和第二驱动信号，所述的第一驱动信号和第二驱动信号分别控制所述的第二电机和第一电机，其中，通过所述的第一电机的第二驱动信号和通过所述的第二电机的第一驱动信号经过信号处理器合成之后，控制AGV小车的运动。
2.根据权利要求1所述的医用AGV控制系统，其特征在于，所述的处理器单元为一双核处理器，包括DSP处理器、FPGA处理器以及设于DSP处理器和FPGA处理器的上位机系统和运动控制系统，所述的所述的上位机系统包括人机界面模块、路径规划模块以及在线输出模块，所述的运动控制系统包括伺服控制模块、数据存储模块以及I/O控制模块，其中，DSP处理器用于控制人机界面模块、路径规划模块、在线输出模块、数据存储模块以及I/O控制模块，FPGA处理器用于控制伺服控制模块，且DSP处理器及FPGA处理器之间实时进行数据交换和调用。
3.根据权利要求1所述的医用AGV控制系统，其特征在于，所述的人工装卸控制系统还包括电池，所述电池进一步与第一电机和第二电机的输出端连接，且处理器单元进一步连接至第二电机输出端和电池之间的连接点。
4.根据权利要求2所述的医用AGV控制系统，其特征在于，所述的伺服控制模块还包括转换模块，所述的转换模块包括模拟数字转换器及数字模拟转换器。
5.根据权利要求2所述的医用AGV控制系统，其特征在于，所述的伺服控制模块还包括编码器模块，所述的编码器模块用于检测AGV小车实际转速，判断是否符合速度要求，是否过快或过慢，并发出控制信号。
6.根据权利要求3所述的医用AGV控制系统，其特征在于，所述的伺服控制模块还包括电流模块，所述的电流模块用于调整电池的供电功率达到AGV小车需要的范围。
7.根据权利要求5所述的医用AGV控制系统，其特征在于，所述的伺服控制模块还包括速度模块，所述的速度模块与编码器模块通讯连接，当编码器模块检测AGV小车实际转速过快或过慢，速度模块根据编码器模块检测的结果来调节AGV小车实际转速。
8.根据权利要求2所述的医用AGV控制系统，其特征在于，所述的伺服控制模块还包括位移模块，所述的位移模块用于检测AGV小车是否到站，是否到达既定位移，如果过慢，发出加速指令至控制器；如果离既定位移过近，需要减速，则发出减速指令至控制器。
9.根据权利要求1所述的医用AGV控制系统，其特征在于，所述的AGV小车包括导航正向传感器、导航反向传感器、前方壁障传感器、左右侧面壁障传感器、站点传感器和返回路径传感器，所述的导航正向传感器和导航反向传感器判断AGV小车是否在中线运行，并调整AGV小车在适当的运行位置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201210353306.6A CN102830706B (zh) | 2012-09-21 | 2012-09-21 | 医用agv控制系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201210353306.6A CN102830706B (zh) | 2012-09-21 | 2012-09-21 | 医用agv控制系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN102830706A true CN102830706A (zh) | 2012-12-19 |
| CN102830706B CN102830706B (zh) | 2016-01-20 |
Family
ID=47333877
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201210353306.6A Active CN102830706B (zh) | 2012-09-21 | 2012-09-21 | 医用agv控制系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN102830706B (zh) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103425127A (zh) * | 2013-07-26 | 2013-12-04 | 广西曼彻彼斯自动化设备有限公司 | 一种轨道小车的智能控制系统与方法 |
| CN106074048A (zh) * | 2016-07-28 | 2016-11-09 | 江苏若博机器人科技有限公司 | 一种双核三轮驱动高速机器人电动病床控制器 |
| CN106176085A (zh) * | 2016-07-28 | 2016-12-07 | 江苏若博机器人科技有限公司 | 一种无线双核三轮驱动高速机器人电动病床控制器 |
| CN107918384A (zh) * | 2016-10-09 | 2018-04-17 | 浙江国自机器人技术有限公司 | 一种库存物品管理系统、运载装置及其与被运载物的对接方法 |
| CN108578134A (zh) * | 2018-03-15 | 2018-09-28 | 浙江大学医学院附属妇产科医院 | 一种医用agv小车智能分配系统 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102073302A (zh) * | 2009-11-25 | 2011-05-25 | 北京诺信泰伺服科技有限公司 | 全数字化分布式智能伺服驱动器 |
| CN202838022U (zh) * | 2012-09-21 | 2013-03-27 | 苏州工业园区职业技术学院 | 医用agv控制系统 |
-
2012
- 2012-09-21 CN CN201210353306.6A patent/CN102830706B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102073302A (zh) * | 2009-11-25 | 2011-05-25 | 北京诺信泰伺服科技有限公司 | 全数字化分布式智能伺服驱动器 |
| CN202838022U (zh) * | 2012-09-21 | 2013-03-27 | 苏州工业园区职业技术学院 | 医用agv控制系统 |
Non-Patent Citations (1)
| Title |
|---|
| 郭健 等: "基于嵌入式控制系统的视觉导引自动小车设计", 《测控技术》 * |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103425127A (zh) * | 2013-07-26 | 2013-12-04 | 广西曼彻彼斯自动化设备有限公司 | 一种轨道小车的智能控制系统与方法 |
| CN103425127B (zh) * | 2013-07-26 | 2014-07-02 | 广西曼彻彼斯自动化设备有限公司 | 一种轨道小车的智能控制系统与方法 |
| CN106074048A (zh) * | 2016-07-28 | 2016-11-09 | 江苏若博机器人科技有限公司 | 一种双核三轮驱动高速机器人电动病床控制器 |
| CN106176085A (zh) * | 2016-07-28 | 2016-12-07 | 江苏若博机器人科技有限公司 | 一种无线双核三轮驱动高速机器人电动病床控制器 |
| CN107918384A (zh) * | 2016-10-09 | 2018-04-17 | 浙江国自机器人技术有限公司 | 一种库存物品管理系统、运载装置及其与被运载物的对接方法 |
| CN108578134A (zh) * | 2018-03-15 | 2018-09-28 | 浙江大学医学院附属妇产科医院 | 一种医用agv小车智能分配系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN102830706B (zh) | 2016-01-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102830703B (zh) | 单机驱动自动装卸agv控制系统 | |
| CN102830706A (zh) | 医用agv控制系统 | |
| CN102341322B (zh) | 自动存储系统和运输工具 | |
| CN103135548B (zh) | 一种无人搬运小车及其驱动控制系统 | |
| CN103425127B (zh) | 一种轨道小车的智能控制系统与方法 | |
| CN102768537B (zh) | 自动导引车辆无线控制系统 | |
| CN202600484U (zh) | 基于dsp和双磁导航传感器的agv控制器 | |
| CN106708027A (zh) | 一种无人导航智能电动平车的在线图形化实时导航与控制系统 | |
| US20210394662A1 (en) | Intelligent transfer vehicle for shared bicycles | |
| CN102707718A (zh) | 自动制导系统控制工业车辆的通信方法 | |
| CN104442452A (zh) | 无人驾驶电动无轨三向堆垛叉车 | |
| CN105621041B (zh) | 一种自动引导运输车 | |
| CN104878970A (zh) | 一种agv载车板交换汽车搬运机器人 | |
| CN102749922A (zh) | 人工装卸自动导引车辆控制系统 | |
| CN102830705B (zh) | 医用agv物流控制系统 | |
| CN202838022U (zh) | 医用agv控制系统 | |
| CN104057944A (zh) | 一种叉车的半自动行驶控制系统及方法 | |
| CN109748203A (zh) | 一种agv自动化运行系统及控制方法 | |
| KR101288373B1 (ko) | 차량 섀시 메리지 무인반송시스템 | |
| CN213262099U (zh) | 一种侧卸式纯电动无人驾驶矿用运输车 | |
| CN202929480U (zh) | 医用agv物流控制系统 | |
| CN102830704A (zh) | 单机驱动人工装卸agv控制系统 | |
| CN202518762U (zh) | 一种手自一体化搬运车 | |
| CN115771582A (zh) | 一种用于阳极板运输的agv小车 | |
| CN206298317U (zh) | 一种具有高精度倒车定位功能的叉车型agv系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| C41 | Transfer of patent application or patent right or utility model | ||
| CB03 | Change of inventor or designer information |
Inventor after: Zhang Haoming Inventor before: Zhang Haoming Inventor before: Wang Yinghai Inventor before: Shi Xiaobo |
|
| COR | Change of bibliographic data | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20160322 Address after: 215021 Suzhou Industrial Park, Jiangsu, if waterway No. 1 Patentee after: Zhang Haoming Address before: 215021 Jiangsu Province, Suzhou City Industrial Park Susie No. 68 Patentee before: Suzhou Industrial Park Institute of Vocational Technology |
|
| C41 | Transfer of patent application or patent right or utility model | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20160630 Address after: 211106, Jiangsu, Nanjing, Jiangning economic and Technological Development Zone, No. 19 Su source Avenue, Kowloon lake international enterprise headquarters park, block C4, first floor Patentee after: Jiangsu Robobor Bobot Technology Co., Ltd. Address before: 215021 Suzhou Industrial Park, Jiangsu, if waterway No. 1 Patentee before: Zhang Haoming |
|
| TR01 | Transfer of patent right |
Effective date of registration: 20211214 Address after: 211102 floor 20, building A1, Jiulong lake international enterprise headquarters park, No. 19, Suyuan Avenue, Jiangning District, Nanjing, Jiangsu Province (Jiangning Development Zone) Patentee after: Nanjing mini automobile technology Co.,Ltd. Address before: 211106 first floor, block C4, Kowloon Lake International Business Park, 19 Jiangning economic and Technological Development Zone, Nanjing, Jiangsu. Patentee before: JIANGSU RUOBO ROBOT TECHNOLOGY Co.,Ltd. |
|
| TR01 | Transfer of patent right |