CN113126616B - 基于rfid的双磁条导航潜伏式agv小车及控制方法 - Google Patents

基于rfid的双磁条导航潜伏式agv小车及控制方法 Download PDF

Info

Publication number
CN113126616B
CN113126616B CN202110234748.8A CN202110234748A CN113126616B CN 113126616 B CN113126616 B CN 113126616B CN 202110234748 A CN202110234748 A CN 202110234748A CN 113126616 B CN113126616 B CN 113126616B
Authority
CN
China
Prior art keywords
agv
jacking
chassis
magnetic
rfid
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.)
Active
Application number
CN202110234748.8A
Other languages
English (en)
Other versions
CN113126616A (zh
Inventor
张科文
徐嘉益
张木成
郑磊
贺帅
潘柏松
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang University of Technology ZJUT
Original Assignee
Zhejiang University of Technology ZJUT
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang University of Technology ZJUT filed Critical Zhejiang University of Technology ZJUT
Priority to CN202110234748.8A priority Critical patent/CN113126616B/zh
Publication of CN113126616A publication Critical patent/CN113126616A/zh
Application granted granted Critical
Publication of CN113126616B publication Critical patent/CN113126616B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0255Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • G05D1/0263Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Acoustics & Sound (AREA)
  • Optics & Photonics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

一种基于RFID的双磁条导航潜伏式AGV小车,包括顶升机构、步进电机和用于承载物品的底盘,底盘的对称位置安装2个磁条传感器,底盘上安装RFID传感器,顶升机构带动顶升台子进行上升,同时设置导向连接板与顶升台子部分连接;顶升板与顶升台子至少部分连接,顶升机构和导向连接板都设置在丝杠底座上,丝杠底座与底盘进行连接,丝杠底座下面安装小齿轮与大齿轮,步进电机的输出轴与小齿轮的转轴连接,小齿轮与大齿轮啮合,大齿轮的转轴上安装顶升机构。以及提供一种基于RFID的双磁条导航潜伏式AGV小车的控制方法。本发明提高柔性系统搬运效率和仓储系统的存、取效率,满足仓储AGV在搬运货架过程中的各种复杂的姿态要求。

Description

基于RFID的双磁条导航潜伏式AGV小车及控制方法
技术领域
本发明涉及一种基于RFID的双磁条导航潜伏式AGV小车及控制方法。
背景技术
随着科学技术的发展,制造业逐渐向智能化转变,智能制造必然是未来的一种新兴的生产模式。而用于物料运输的自动导引小车(Automatic Guided Vehicle,AGV)将会大量运用。AGV作为智能制造系统的一部分,能提高生产效率,有利于实现信息化、智能化。AGV可以提高企业生产的信息化水平,并且能代替部分人力,提高生产效率,增加企业收益,甚至是有利于之后实现智能制造。
AGV是多学科交叉的产物,控制系统是其核心,目前大量的AGV选用微型主机或单片机作为控制核心,微控制器(MCU)可以减小控制系统所占的空间,且功耗较低,但所需要的调试时间较长,运算能力和拓展能力较差,可以实现的人机交互效果一般。在实际使用中AGV的自主导航能力、障碍检测能力、电池管理性能一直是各AGV厂家的研发重点,特别是AGV的导航可靠性与准确性。引导技术作为AGV的核心技术之一,引导技术体现了AGV的智能程度,目前,常用的引导技术有电磁引导、磁带引导、激光引导、惯性引导、光学引导、视觉引导等。其障碍检测存在一定的盲区,并且存在车身较大,导航精度不高的问题,同时机构没办法自主搬运货物,无法满足企业等市场的需求等问题。
发明内容
为了克服已有技术的不足,本发明提供一种基于RFID的双磁条导航潜伏式AGV小车及控制方法,提高柔性系统搬运效率和仓储系统的存、取效率,满足仓储AGV在搬运货架过程中的各种复杂的姿态要求。
本发明解决其技术问题所采用的技术方案是:
一种基于RFID的双磁条导航潜伏式AGV小车,包括顶升机构、步进电机和用于承载物品的底盘,所述底盘的对称位置安装2个磁条传感器,所述底盘上安装RFID传感器,所述顶升机构采用丝杠螺母传动沿竖直方向使旋转运动转化为直线移动,同时带动顶升台子进行上升,同时设置导向连接板与顶升台子部分连接,防止上升过程中容易打滑;顶升板与顶升台子至少部分连接,以使顶升台子带动顶升板沿竖直方向移动;所述顶升机构和导向连接板都设置在丝杠底座上,丝杠底座与底盘进行连接,所述丝杠底座下面安装小齿轮与大齿轮,步进电机的输出轴与小齿轮的转轴连接,小齿轮与大齿轮啮合,所述大齿轮的转轴上安装所述顶升机构。
进一步,所述AGV小车还包括直流电机固定架、从动轮固定支架,所述直流电机固定架上固定直流电机带动底盘的主动轮运动,所述从动轮固定架上固定万向轮。
再进一步,所述AGV小车还包括电源固定架,所述电源固定架与底盘部分连接,所述电源固定架上面承载电源。
所述AGV小车还包括支架,所述支架与外壳连接,外壳上安装显示模块、超声波传感器、激光传感器和视觉传感器。
一种基于RFID的双磁条导航潜伏式AGV小车的控制方法,其特征在于,RFID传感器读出电子标签的数据信息,传给AGV的控制器,控制器分析数据信息,执行搬运任务或停止操作:AGV小车行驶过程中,检测到上升电子标签之后AGV停下来之后,完成承载货物操作,检测到下一个下降电子标签,AGV停下来,完成卸载操作,然后继续完成搬运任务;
通过2个磁条传感器判别小车相对于轨道的偏移量,得到AGV相对与地面磁条的偏移量和偏移角度。
进一步,通过驱动机构控制AGV基于导航运行,采用增量式PID算法设计,得到了以下的数字PID增量式控制算法:
其中:u(k)表示第k次采样时的输入;e(k)表示第k次采样时的偏差;e(k-1)表示第k-1次采样时的偏差;e(k-2)表示第k-2次采样时的偏差;KP是系统比例系数;KI是积分常数;KD是微分常数;
将磁传感器的得到的偏差量作为PID控制器的输入量,左右轮的速度差作为控制输出量,控制增量Δu(k)的确定仅与最近3次的采样值有关,没有误差累加,使控制输出更加准确。
PID算法的优劣与其三个参数相关,为使参数最优采用粒子群优化算法对PID参数进行整定。
所述控制方法中,控制循迹是基于PID控制算法的循迹控制程序设计,时刻检测距离信息、磁传感器数据、调整电机速度。循迹程序首先获取超声波传感器和激光模组的距离信息,以及激光模组的角度,通过这些数据判断当前设定范围内是否存在障碍物;如果检测到障碍物那么AGV停止,如果没有检测到障碍物,获取前后2个磁条传感器的数据。
本发明的有益效果主要表现在:
1.提高柔性系统搬运效率和仓储系统的存、取效率;同时,由于仓储系统中货物堆放密集,AGV的尺寸规格要尽可能的小,除此之外,AGV自带顶升机构,通过RFID定位进行定位控制,确保AGV在运行的过程中能够按要求严格的控制车身和搬运货物的相对位置。
2.AGV具有顶升货架背负行走的功能,顶升台子可随着AGV底盘360旋转而进行上升运动,满足仓储AGV在搬运货架过程中的各种复杂的姿态要求。
附图说明
图1为一种基于RFID的双磁条导航潜伏式AGV小车的实施例的剖视图;
图2为一种基于RFID的双磁条导航潜伏式AGV小车的结构示意图;
图3为一种基于RFID的双磁条导航潜伏式AGV小车的主视图;
图4为本发明的双输入PID控制功能框图。
图5为本发明的循迹控制模块流程图。
图6为本发明的树莓派模块设计流程图。
其中,上述附图包括以下附图标记:
1、导向连接板;2、顶升台子;3、顶升机构;4、支架;5、步进电机;6、磁条传感器;7、L型支架;8、RFID传感器;9、丝杠底座;10、直流电机;11、直流电机固定架;12、从动轮支架;13、电源;14、小齿轮;15、底盘;16、主动轮;17、大齿轮;18、AGV控制器;19、电源固定架;20、继电器;22、顶升板;23、外壳;24、万向轮;25、显示模块;26、超声波传感器;27、激光传感器;28、视觉传感器。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1~图6,一种基于RFID的双磁条导航潜伏式AGV小车,包括顶升机构3、步进电机5和用于承载物品的底盘15,所述底盘15的对称位置安装2个磁条传感器6,所述底盘15上安装RFID传感器8,顶升机构3沿竖直方向可螺旋移动,同时带动顶升台子2进行上升,同时设置导向连接板1与顶升台子2部分连接,防止上升过程中容易打滑;顶升板20与顶升台子2至少部分连接,以使顶升台子2带动顶升板20沿竖直方向移动;步进电机5,设置在丝杠底座9上,顶升机构3与导向连接板1都设置在丝杠底座9上,丝杠底座9与底盘15进行连接,丝杠底座9下面安装小齿轮14与大齿轮17,步进电机5提供动力,然后使小齿轮14进行传动,小齿轮14带动大齿轮17进行传动,大齿轮17带动顶升机构3运转,最终导致顶升台子上升用于承载货物。
AGV小车还包括直流电机固定架11、从动轮固定支架12,分别用于固定直流电机10与万向轮24,直流电机10的输出轴带动主动轮16运动。
电源固定架19与底盘15部分连接,上面承载电源13,同时还有支架4(采用铝型材),支架4与外壳23连接,外壳23上面用以安装显示模块25、超声波传感器26、激光传感器27和视觉传感器28。
本实施例的基于RFID的双磁条导航潜伏式AGV小车,底盘15上安装有直流电机固定架11、磁条传感器6、RFID传感器8、电源13、万向轮22等,还安装控制系统,包含有AGV控制器18、继电器20、电压转换模块21、直流电机10等控制相关的器件,顶升机构3同时位于整体机构中间位置,起承载作用。
避障检测装置从多传感器融合以及机构结构为切入点,利用超声波传感器26、激光传感器27、视觉传感器28,3种传感器实现障碍物的检测,并且设计通过机械结构使得激光测距模组由原本的点对点测距变成范围内测距。对于复杂路障也能正确识别,安全停靠,有效减少了障碍检测盲区,提高了AGV运行的安全性。
结合两种测距传感器,设计测距模块,其中两种传感器分层布置,实现不同空间的障碍物检测;激光测距传感器27可在-1°~51°角度范围内实现转动,调整障碍物检测的高度,超声波传感器26与外壳23进行部分连接。
基于RFID定位方式进行定位,当AGV靠近电子标签时,地盘上的RFID读卡器8会读出电子标签的数据信息,传给AGV的控制器18,控制器18分析数据信息,来决定下一步的操作。
根据RFID传感器8检测结果控制执行搬运任务或停止操作。AGV小车行驶过程中,检测到上升电子标签之后AGV停下来之后,顶升机构3完成承载货物操作,检测到下一个下降电子标签,AGV停下来,顶升机构3完成卸载操作,然后继续完成搬运任务。
磁条传感器6是AGV最主要的传感器,双磁条导航方式是在对称位置安装2个磁条传感器6,通过该方式判别小车相对于轨道的偏移量,得到AGV相对与地面磁条的偏移量和偏移角度。
AGV控制器18通过驱动机构控制AGV实现导航运行;采用增量式PID算法设计,得到了以下的数字PID增量式控制算法:
其中:u(k)表示第k次采样时的输入;e(k)表示第k次采样时的偏差;e(k-1)表示第k-1次采样时的偏差;e(k-2)表示第k-2次采样时的偏差;KP是系统比例系数;KI是积分常数;KD是微分常数。
将磁传感器的得到的偏差量作为PID控制器的输入量,左右轮的速度差作为控制输出量。控制增量Δu(k)的确定仅与最近3次的采样值有关,没有误差累加,使控制输出更加准确。
PID算法的优劣与其三个参数相关,为使参数最优采用粒子群优化算法对PID参数进行整定。
如图5所示,AGV小车的控制系统控制循迹是基于PID控制算法的循迹控制设计,时刻检测距离信息、磁传感器数据、调整电机速度。循迹程序首先获取超声波传感器和激光模组的距离信息,以及激光模组的角度,通过这些数据判断,当前一定范围内是否存在障碍物。如果检测到障碍物那么AGV停止,如果没有检测到障碍物,获取前后两个磁传感器的数据,沿磁带进行前行。
如图6所示,AGV控制器18还包括树莓派模块,其中包含STM32单片机进行串口通讯、障碍物识别等。
本说明书实施例所述的内容仅仅是对发明构思的实现形式的列举,本发明的保护范围不应当被视为仅限于实施例所陈述的具体形式,本发明的保护范围也及于本领域技术人员根据本发明构思所能够想到的等同技术手段。

Claims (2)

1.一种基于RFID的双磁条导航潜伏式AGV小车,其特征在于,包括顶升机构、步进电机和用于承载物品的底盘,所述底盘的对称位置安装2个磁条传感器,所述底盘上安装RFID传感器,所述顶升机构采用丝杠螺母传动沿竖直方向使旋转运动转化为直线移动,同时带动顶升台子进行上升,同时设置导向连接板与顶升台子部分连接,防止上升过程中容易打滑;顶升板与顶升台子至少部分连接,以使顶升台子带动顶升板沿竖直方向移动;所述顶升机构和导向连接板都设置在丝杠底座上,丝杠底座与底盘进行连接,所述丝杠底座下面安装小齿轮与大齿轮,步进电机的输出轴与小齿轮的转轴连接,小齿轮与大齿轮啮合,所述大齿轮的转轴上安装所述顶升机构;
所述AGV小车还包括直流电机固定架、从动轮固定支架,所述直流电机固定架上固定直流电机带动底盘的主动轮运动,所述从动轮固定架上固定万向轮;所述AGV小车还包括电源固定架,所述电源固定架与底盘部分连接,所述电源固定架上面承载电源;所述AGV小车还包括支架,所述支架与外壳连接,外壳上安装显示模块、超声波传感器、激光传感器和视觉传感器。
2.一种基于RFID的双磁条导航潜伏式AGV小车的控制方法,其特征在于,RFID传感器读出电子标签的数据信息,传给AGV的控制器,控制器分析数据信息,执行搬运任务或停止操作:AGV小车行驶过程中,检测到上升电子标签之后AGV停下来之后,完成承载货物操作,检测到下一个下降电子标签,AGV停下来,完成卸载操作,然后继续完成搬运任务;
通过2个磁条传感器判别小车相对于轨道的偏移量,得到AGV相对与地面磁条的偏移量和偏移角度;
通过驱动机构控制AGV基于导航运行,采用增量式PID算法设计,得到了以下的数字PID增量式控制算法:
其中:u(k)表示第k次采样时的输入;e(k)表示第k次采样时的偏差;e(k-1)表示第k-1次采样时的偏差;e(k-2)表示第k-2次采样时的偏差;KP是系统比例系数;KI是积分常数;KD是微分常数;
将磁传感器的得到的偏差量作为PID控制器的输入量,左右轮的速度差作为控制输出量;
所述控制方法中,控制循迹是基于PID控制算法的循迹控制程序设计,时刻检测距离信息、磁传感器数据、调整电机速度;循迹程序首先获取超声波传感器和激光模组的距离信息,以及激光模组的角度,通过这些数据判断当前设定范围内是否存在障碍物;如果检测到障碍物那么AGV停止,如果没有检测到障碍物,获取前后2个磁条传感器的数据。
CN202110234748.8A 2021-03-03 2021-03-03 基于rfid的双磁条导航潜伏式agv小车及控制方法 Active CN113126616B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110234748.8A CN113126616B (zh) 2021-03-03 2021-03-03 基于rfid的双磁条导航潜伏式agv小车及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110234748.8A CN113126616B (zh) 2021-03-03 2021-03-03 基于rfid的双磁条导航潜伏式agv小车及控制方法

Publications (2)

Publication Number Publication Date
CN113126616A CN113126616A (zh) 2021-07-16
CN113126616B true CN113126616B (zh) 2024-06-21

Family

ID=76772398

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110234748.8A Active CN113126616B (zh) 2021-03-03 2021-03-03 基于rfid的双磁条导航潜伏式agv小车及控制方法

Country Status (1)

Country Link
CN (1) CN113126616B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114014217B (zh) * 2021-09-30 2023-05-16 宁波力达物流设备有限公司 背负式agv车
CN114572216B (zh) * 2022-03-28 2023-01-03 安徽怡丰自动化科技有限公司 驱动系统的调节方法、调节装置、清洗设备及存储介质
CN116281664B (zh) * 2023-03-06 2024-01-23 中海福陆重工有限公司 一种基于spmt的履带吊承载装置及控制系统

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN214540525U (zh) * 2021-03-03 2021-10-29 浙江工业大学 一种基于rfid的双磁条导航潜伏式agv小车

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104833356A (zh) * 2015-04-30 2015-08-12 王英英 一种便于铺设的抗干扰型机器人引导磁条轨道
CN105621041B (zh) * 2016-02-24 2018-05-18 苏州元谋智能机器人系统有限公司 一种自动引导运输车
CN108445888A (zh) * 2018-05-03 2018-08-24 Tcl王牌电器(惠州)有限公司 Agv小车、agv小车的偏移量的确定方法及控制系统
CN108958269B (zh) * 2018-10-09 2024-01-19 南京景曜智能科技有限公司 一种惯导磁条混合导航agv系统
CN110001661A (zh) * 2019-04-15 2019-07-12 安徽意欧斯物流机器人有限公司 一种双目视觉导航叉车式agv控制系统和方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN214540525U (zh) * 2021-03-03 2021-10-29 浙江工业大学 一种基于rfid的双磁条导航潜伏式agv小车

Also Published As

Publication number Publication date
CN113126616A (zh) 2021-07-16

Similar Documents

Publication Publication Date Title
CN113126616B (zh) 基于rfid的双磁条导航潜伏式agv小车及控制方法
WO2018072712A1 (zh) Agv运输车及其控制方法
CN205397170U (zh) 仓储智能搬运机器人及搬运系统
WO2019141257A1 (zh) 应用于智能仓库的全方位移动机器人
CN214540525U (zh) 一种基于rfid的双磁条导航潜伏式agv小车
CN205540268U (zh) 一种基于磁导航的自动避障循迹小车
CN109279543B (zh) 一种叉车式agv磁导轨跟踪控制系统及方法
CN104859440A (zh) 滑移式agv导航小车
CN205375188U (zh) 潜入式agv导航小车
CN108946585A (zh) 无人驾驶叉车和自动化仓储系统及叉车运行方法
CN102495612B (zh) 非接触式供电技术的自动导引车的电气自动控制系统装置
CN112454352B (zh) 自身找平及导航并移动方法、系统、电子设备及介质
CN111716359B (zh) 复合导航式差速仓储机器人及其工作方法
TWI590019B (zh) 雙載具協同運輸系統及其控制方法
CN113697411B (zh) 主动集成智能生产线边缘侧状态信息的agv自适应上料系统
CN113111443A (zh) 智能运输小车及运动模型构建方法
CN211442470U (zh) 一种基于rfid导航行走、可爬坡、越障、实现高低自动调节的车辆
CN212667026U (zh) 一种麦克纳姆轮全向精准到位底盘装置
CN212763484U (zh) 一种物流搬运机器人
Dhabalia et al. An Intelligent Auto-Tracking Vehicle
CN111766856B (zh) 自动导引运输车及其辅助定位方法和系统、车载控制器
CN112722137A (zh) 基于两轮差速驱动的多方位自主跟随平衡车及其控制方法
Shi Laser guided four-wheel drive AGV trolley
Lou Intelligent Car Following System Based on MSP432
CN216102494U (zh) 一种agv小车

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant