CN106909160B - 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置 - Google Patents

一种基于双闭环pid控制的sd型agv倒车姿态角控制装置 Download PDF

Info

Publication number
CN106909160B
CN106909160B CN201510989790.5A CN201510989790A CN106909160B CN 106909160 B CN106909160 B CN 106909160B CN 201510989790 A CN201510989790 A CN 201510989790A CN 106909160 B CN106909160 B CN 106909160B
Authority
CN
China
Prior art keywords
navigation sensor
magnetic navigation
attitude angle
agv
controller
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
CN201510989790.5A
Other languages
English (en)
Other versions
CN106909160A (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.)
Keda Clean Energy Co Ltd
Original Assignee
Keda Clean Energy Co Ltd
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 Keda Clean Energy Co Ltd filed Critical Keda Clean Energy Co Ltd
Priority to CN201510989790.5A priority Critical patent/CN106909160B/zh
Publication of CN106909160A publication Critical patent/CN106909160A/zh
Application granted granted Critical
Publication of CN106909160B publication Critical patent/CN106909160B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles

Landscapes

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

Abstract

本发明公开了一种基于双闭环PID控制的SD型AGV倒车姿态角控制装置,包括控制器,控制器设置在AGV车体上;第一磁导航传感器,第一磁导航传感器设置在AGV车头,第一磁导航传感器接入到所述控制器的GPIO口;第二磁导航传感器,第二磁导航传感器设置在AGV后部,第二磁导航传感器接入到所述控制器的GPIO口;运动控制器,运动控制器与控制器采用CAN通信连接;伺服闭环控制系统,伺服闭环控制系统通过RS485与控制器通信连接。本发明经过两级PID控制运算,得出AGV车体倒车的姿态角打角值,解决了现有技术中SD型AGV只能单向行走缺少倒车功能的技术难题。

Description

一种基于双闭环PID控制的SD型AGV倒车姿态角控制装置
技术领域
本发明涉及AGV领域,尤其涉及一种基于双闭环PID控制的SD型AGV倒车姿态角控制装置及方法。
背景技术
AGV是Automated Guided Vehicle的缩写,意即“自动导引运输车”,是指装备有电磁或光学等自动导引装置,它能够沿规定的导引路径行驶,具有安全保护以及各种移载功能的运输车,AGV属于轮式移动机器人(Wheeled Mobile Robot)的范畴。
AGV通过装备有电磁、光学陀螺仪、激光导航仪或GPRS等自动导引装置,能够沿着规划的路径实现物流输送的任务。随着工厂自动化水平的提高及人力资源成本的猛增,AGV在国内得到迅猛的发展,在电力电子、家电、烟草等行业得到广泛的应用。随着中国制造2015、工业4.0及互联网+时代的推进,AGV及AGVS在现代制造工厂及物流行业更加有很高的发展空间。
目前,广泛使用的AGV主要是小型的潜伏式或拖曳式车型,采用的驱动方式是前后轮差速驱动。SD型AGV采用单轮驱动的方式,车体结构采用单轮驱动及转向,另外两轮作为车体承重轮。基于单轮驱动及转向的方式,SD型AGV在倒车过程中,控制方式比较特别,除了需要控制车体的横向距离偏差以外,还需要控制车体与导航磁条之间的姿态角。目前现有的SD型AGV都只能单向行走而缺少倒车的功能,灵活性比较差,因此,基于实际的功能需求,需要解决目前SD型AGV倒车姿态角控制的问题。
发明内容
为了克服现有技术中存在的缺点和不足,本发明提供了一种基于双闭环PID控制的SD型AGV倒车姿态角控制装置及方法。
本发明是通过以下技术方案实现的:一种基于双闭环PID控制的SD型AGV倒车姿态角控制装置,包括
--控制器,所述控制器设置在AGV车体上;
--第一磁导航传感器,所述第一磁导航传感器设置在AGV车头,所述第一磁导航传感器接入到所述控制器的GPIO口;
--第二磁导航传感器,所述第二磁导航传感器设置在AGV后部,所述第二磁导航传感器接入到所述控制器的GPIO口;
--运动控制器,所述运动控制器设置在AGV车体上,所述运动控制器与控制器采用CAN通信连接;
--伺服闭环控制系统,所述伺服闭环控制系统通过RS485与控制器通信连接,从而接收姿态角调整指令。
进一步地,所述闭环伺服控制系统包括相互通信连接的伺服驱动器、旋转编码器和伺服转向电机。
进一步地,所述控制器为STM32F103ZTE芯片。
进一步地,所述控制器采用LQFP封装形式。
进一步地,所述第一磁导航传感器和第二磁导航传感器分别为16位磁导航传感器和8位磁导航传感器,且第一磁导航传感器和第二磁导航传感器采用NPN输入。
进一步地,所述第一磁导航传感器和第二磁导航传感器的安装间距D为188cm。
同时,本发明还提供了一种基于双闭环PID控制的SD型AGV倒车姿态角控制方法,包括以下步骤:
S1:预设第一磁导航传感器的中心位置值SP1和第二磁导航传感器的中心位置值SP2;
S2:根据第一磁导航传感器的实际检测值PV1,计算获得第一磁导航传感器的中心位置值SP1与实际检测值PV1的差值E1,其中,E1=SP1-PV1;
根据第二磁导航传感器的实际检测值PV2,计算获得第二磁导航传感器的中心位置值SP2与实际检测值PV2的差值E2,其中,E2=SP2-PV2;
S3:将E2进行第一级距离偏差PID运算并输出运算结果SP3;
S4:根据第一磁导航传感器和第二磁导航传感器的安装间距D及E1和E2,计算获得实际姿态角的计算值PV3,其中,PV3=(E2-E1)/D;
S5:计算获得预设姿态角与实际姿态角的差值E3,其中,E3=SP3-PV3;
S6:将E3作为第二级姿态角PID运算的输入值,运算输出结果α即为AGV车体倒车的姿态角打角值。
进一步地,上述步骤包含以下特征:所述SP1=7.5cm,SP2=3.5cm,D=188cm。
进一步地,上述步骤包含以下特征:初始状态或稳定运行状态下,E1=0,E2=0。
相对于现有技术,本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制装置通过在AGV上设置第一磁导航传感器和第二磁导航传感器,并将二者的检测值输入控制器,经过两级PID控制运算,得出AGV车体倒车的姿态角打角值,解决了现有技术中SD型AGV只能单向行走缺少倒车功能的技术难题,具有突破意义。本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制方法采用两级双闭环PID的运算,突破了现有技术中采用单PID控制的技术缺陷,在SD型AGV领域,具有很强的指导意义和推广价值。
为了更好地理解和实施,下面结合附图详细说明本发明。
附图说明
图1是本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制装置的连接示意图。
图2是磁导航传感器的安装位置示意图。
图3是SD型AGV的运动数学模型图。
图4是本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制方法的系统控制框图。
具体实施方式
请参阅图1-图4。图1是本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制装置的连接示意图。图2是磁导航传感器的安装位置示意图。图3是SD型AGV的运动数学模型图。图4是本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制方法的系统控制框图。本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制装置,包括
--控制器3,控制器3设置在AGV车体上;
--第一磁导航传感器1,第一磁导航传感器1设置在AGV车头,第一磁导航传感器1接入到控制器3的GPIO口;
--第二磁导航传感器2,第二磁导航传感器2设置在AGV后部的落地叉处,第二磁导航传感器2接入到控制器3的GPIO口;
--运动控制器4,运动控制器4设置在AGV车体上,运动控制器4与控制器3采用CAN通信连接,控制器3通过接收运动控制器4发送的动作指令,执行相应的算法程序;
--伺服闭环控制系统,伺服闭环控制系统通过RS485与控制器通信连接,从而接收姿态角调整指令。
具体地,闭环伺服控制系统包括相互通信连接的伺服驱动器、旋转编码器和伺服转向电机,伺服转向电机通过齿轮的方式来实现驱动轮的转向。本实施例的控制器3为STM32F103ZTE芯片并采用LQFP封装形式。
第一磁导航传感器1和第二磁导航传感器2分别为16位磁导航传感器和8位磁导航传感器,且第一磁导航传感器1和第二磁导航传感器2采用NPN输入,二者的输入信号经过软件的滤波处理,消除对算法的噪声干扰。本实施例优选地将第一磁导航传感器1和第二磁导航传感器2的安装间距D设置为D=188cm,并且,优选地将第一磁导航传感器1的中心位置值SP1设置为SP1=7.5cm,第二磁导航传感器2的中心位置值SP2设置为SP2=3.5cm。
为了更好地理解本发明,本实施例优选地在图2中标示了AGV的前轮10、后轮20以及设置在AGV车体下的导航磁条30。本实施例的前轮10为AGV车体的驱动轮,两个后轮20则为AGV车体的承重轮。
本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制装置在控制算法上采用两级双闭环PID的控制方法,下面具体说明该方法。
本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制方法,包括以下步骤:
S1:预设第一磁导航传感器的中心位置值SP1和第二磁导航传感器的中心位置值SP2。
通过运算控制器4对AGV车体的运动进行预设,本实施例的第一磁导航传感器的中心位置值SP1预设为7.5cm,第二磁导航传感器的中心位置值SP2预设为3.5cm。
S2:根据第一磁导航传感器的实际检测值PV1,计算获得第一磁导航传感器的中心位置值SP1与实际检测值PV1的差值E1,其中,E1=SP1-PV1。
根据第二磁导航传感器的实际检测值PV2,计算获得第二磁导航传感器的中心位置值SP2与实际检测值PV2的差值E2,其中,E2=SP2-PV2。
请参阅图2,当AGV车体处于稳定运行状态或初始状态时,第一磁导航传感器1及第二磁导航传感器2的中心位置均位于导航磁条30的正上方,即此时,E1=0,E2=0。
S3:将E2进行第一级距离偏差PID运算并输出运算结果SP3。
S4:根据第一磁导航传感器和第二磁导航传感器的安装间距D及E1和E2,计算获得实际姿态角的计算值PV3,其中,PV3=(E2-E1)/D。
如图3所示,箭头方向表示AGV车体处于倒车状态,其中,AGV车体与X方向之间的夹角θ表示AGV车体的实际姿态角,由几何关系,可以算出AGV车体的实际姿态角θ的计算值PV3=(E2-E1)/D。实际姿态角θ的计算值PV3作为第二级姿态角PID运算的预设输入姿态角值。
S5:计算获得预设姿态角与实际姿态角的差值E3,其中,E3=SP3-PV3。
根据SD型AGV的运动数学模型,将计算得出的预设姿态角与实际姿态角的差值E3作为第二级姿态角PID控制的输入值。
S6:将E3作为第二级姿态角PID运算的输入值,运算输出结果α即为AGV车体倒车的姿态角打角值。
根据第二级姿态角PID运算的计算结果,将姿态角打角值α的指令传送给闭环伺服控制系统的伺服转向电机,从而平稳地控制AGV车体倒车的姿态角。
相对于现有技术,本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制装置通过在AGV上设置第一磁导航传感器和第二磁导航传感器,并将二者的检测值输入控制器,经过两级PID控制运算,得出AGV车体倒车的姿态角打角值,解决了现有技术中SD型AGV只能单向行走缺少倒车功能的技术难题,具有突破意义。本发明的基于双闭环PID控制的SD型AGV倒车姿态角控制方法采用两级双闭环PID的运算,突破了现有技术中采用单PID控制的技术缺陷,在SD型AGV领域,具有很强的指导意义和推广价值。
本发明并不局限于上述实施方式,如果对本发明的各种改动或变形不脱离本发明的精神和范围,倘若这些改动和变形属于本发明的权利要求和等同技术范围之内,则本发明也意图包含这些改动和变形。

Claims (8)

1.一种基于双闭环PID控制的SD型AGV倒车姿态角控制装置,其特征在于:包括
控制器,所述控制器设置在AGV车体上;
第一磁导航传感器,所述第一磁导航传感器设置在AGV车头,所述第一磁导航传感器接入到所述控制器的GPIO口,用于获取所述第一磁导航传感器的实际检测值;
第二磁导航传感器,所述第二磁导航传感器设置在AGV后部,所述第二磁导航传感器接
入到所述控制器的GPIO口,用于获取所述第二磁导航传感器的实际检测值;
运动控制器,所述运动控制器设置在AGV车体上,所述运动控制器与控制器采用CAN通信连接;
伺服闭环控制系统,所述伺服闭环控制系统通过RS485与控制器通信连接,从而接收姿态角调整指令;
所述控制器用于接收所述第一磁导航传感器的实际检测值和所述第二磁导航传感器的实际检测值,经过两级PID控制运算,得出AGV车体倒车的姿态角打角值;
其中,预设第一磁导航传感器的中心位置值SP1和第二磁导航传感器的中心位置值SP2;
根据第一磁导航传感器的实际检测值PV1,计算获得第一磁导航传感器的中心位置值SP1与实际检测值PV1的差值E1,其中,E1=SP1-PV1;
根据第二磁导航传感器的实际检测值PV2,计算获得第二磁导航传感器的中心位置值SP2与实际检测值PV2的差值E2, 其中,E2=SP2-PV2;
将E2进行第一级距离偏差PID运算并输出运算结果SP3;
根据第一磁导航传感器和第二磁导航传感器的安装间距D及E1和E2,计算获得实际姿态角的计算值PV3,其中,PV3=(E2-E1)/D;
计算获得预设姿态角与实际姿态角的差值E3,其中,E3=SP3-PV3;
将E3作为第二级姿态角PID运算的输入值,运算输出结果α即为AGV车体倒车的姿态角打角值。
2.根据权利要求1所述的基于双闭环PID控制的SD型AGV倒车姿态角控制装置,其特征在于:所述伺服闭环控制系统包括相互通信连接的伺服驱动器、旋转编码器和伺服转向电机。
3.根据权利要求1所述的基于双闭环PID控制的SD型AGV倒车姿态角控制装置,其特征在于:所述控制器为STM32F103ZTE芯片。
4.根据权利要求1所述的基于双闭环PID控制的SD型AGV倒车姿态角控制装置,其特征在于:所述控制器采用LQFP封装形式。
5.根据权利要求1所述的基于双闭环PID控制的SD型AGV倒车姿态角控制装置,其特征在于:所述第一磁导航传感器和第二磁导航传感器分别为16位磁导航传感器和8位磁导航传感器,且第一磁导航传感器和第二磁导航传感器采用NPN输入。
6.根据权利要求1所述的基于双闭环PID控制的SD型AGV倒车姿态角控制装置,其特征在于:所述第一磁导航传感器和第二磁导航传感器的安装间距D为188cm。
7.根据权利要求1所述的基于双闭环PID控制的SD型AGV倒车姿态角控制装置,其特征在于:所述SP1=7.5cm,SP2=3.5cm,D=188cm。
8.根据权利要求1所述的基于双闭环PID控制的SD型AGV倒车姿态角控制装置,其特征在于:初始状态或稳定运行状态下,E1=0,E2=0。
CN201510989790.5A 2015-12-23 2015-12-23 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置 Active CN106909160B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510989790.5A CN106909160B (zh) 2015-12-23 2015-12-23 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510989790.5A CN106909160B (zh) 2015-12-23 2015-12-23 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置

Publications (2)

Publication Number Publication Date
CN106909160A CN106909160A (zh) 2017-06-30
CN106909160B true CN106909160B (zh) 2023-07-07

Family

ID=59206330

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510989790.5A Active CN106909160B (zh) 2015-12-23 2015-12-23 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置

Country Status (1)

Country Link
CN (1) CN106909160B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110147042B (zh) * 2019-05-28 2020-06-16 金力 一种基于模糊控制结合pid控制的直立agv车体控制方法
CN111830980B (zh) * 2020-07-14 2023-11-03 上海同普电力技术有限公司 一种激光导航路径跟随方法
CN113650459B (zh) * 2021-08-25 2024-06-28 临沂临工智能信息科技有限公司 用于物料车连接的自动脱挂销方法
CN115042188B (zh) * 2022-07-19 2024-04-30 无锡军工智能电气股份有限公司 一种井下巡检机器人双修正磁导航控制方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09269830A (ja) * 1996-03-29 1997-10-14 Mazda Motor Corp 車両の走行操舵制御装置
CN1634720A (zh) * 2003-12-29 2005-07-06 居永明 可分别独立驱动亦可同时驱动的模块化电动汽车
JP2010256941A (ja) * 2009-04-21 2010-11-11 Meidensha Corp 無人搬送車の操舵駆動方法及び装置
CN201993646U (zh) * 2011-01-27 2011-09-28 合肥工业大学 工业型激光导引agv的双闭环控制系统
CN202423926U (zh) * 2012-02-24 2012-09-05 山东鲁能智能技术有限公司 基于电子地图的变电站巡检机器人手势驱动系统
CN102890511A (zh) * 2012-10-31 2013-01-23 台州清华机电制造有限公司 一种激光导引的sd型agv系统的导引方法
CN203111393U (zh) * 2013-02-08 2013-08-07 方俊忠 一种站立驾驶的三轮电动车
CN104062971A (zh) * 2013-10-25 2014-09-24 浙江吉利控股集团有限公司 智能车自动行车控制系统及其控制方法
CN205263653U (zh) * 2015-12-23 2016-05-25 广东科达洁能股份有限公司 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09269830A (ja) * 1996-03-29 1997-10-14 Mazda Motor Corp 車両の走行操舵制御装置
CN1634720A (zh) * 2003-12-29 2005-07-06 居永明 可分别独立驱动亦可同时驱动的模块化电动汽车
JP2010256941A (ja) * 2009-04-21 2010-11-11 Meidensha Corp 無人搬送車の操舵駆動方法及び装置
CN201993646U (zh) * 2011-01-27 2011-09-28 合肥工业大学 工业型激光导引agv的双闭环控制系统
CN202423926U (zh) * 2012-02-24 2012-09-05 山东鲁能智能技术有限公司 基于电子地图的变电站巡检机器人手势驱动系统
CN102890511A (zh) * 2012-10-31 2013-01-23 台州清华机电制造有限公司 一种激光导引的sd型agv系统的导引方法
CN203111393U (zh) * 2013-02-08 2013-08-07 方俊忠 一种站立驾驶的三轮电动车
CN104062971A (zh) * 2013-10-25 2014-09-24 浙江吉利控股集团有限公司 智能车自动行车控制系统及其控制方法
CN205263653U (zh) * 2015-12-23 2016-05-25 广东科达洁能股份有限公司 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
单轮驱动/转向AGV轨迹分析及视觉导航;赵玉麟;《中国优秀硕士学位论文全文数据库信息科技辑》;20070715(第1期);第5、9、14-15、44页 *

Also Published As

Publication number Publication date
CN106909160A (zh) 2017-06-30

Similar Documents

Publication Publication Date Title
CN106909160B (zh) 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置
EP2888930B1 (en) Automatic guidance system with stability control for an agricultural vehicle
CN111399509B (zh) 一种多移动机器人协同转运控制方法及系统
CN107065873B (zh) 一种基于磁带导引agv的多曲率圆周路径循迹控制方法
CN103048996A (zh) 基于激光扫描测距仪的自动引导车、系统及导航方法
CN107600221B (zh) 一种智能全向agv小车及其控制方法
CN109491390B (zh) 基于多传感器的无轨化全向移动机器人系统及其控制方法
CN108459600A (zh) 一种agv小车的视觉导航系统
CN110320906B (zh) 一种基于麦克纳姆轮的四驱agv小车差速直线行驶姿态调整方法
CN110103998B (zh) 非对称四舵轮agv转向及平移运动的控制方法
US20210214008A1 (en) Transverse steering method and transverse steering device for moving a vehicle into a target position, and vehicle for this purpose
CN111679676A (zh) 一种agv运动轨迹控制方法
US20210200223A1 (en) Robotic motion control method and apparatus and robot using the same
CN105068543A (zh) 一种基于pid控制的背负型agv两轮同步方法
CN112666934A (zh) 一种汽车搬运agv控制系统、调度系统及控制方法
CN205263653U (zh) 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置
CN102231083A (zh) 三轮无轨agv定位停车控制方法
US20210188355A1 (en) Transverse steering method and transverse steering device for moving a vehicle into a target position, and vehicle for this purpose
CN107272693B (zh) 基于全向车与装配工位自动对接系统及方法
CN113219963A (zh) 一种agv平台车双舵轮运动控制系统
CN115993089B (zh) 基于pl-icp的在线四舵轮agv内外参标定方法
CN112660147A (zh) 控制车辆调头的方法、装置、设备和存储介质
CN114216462B (zh) 一种agv自然导航与末端定位的控制系统及方法
CN112612276B (zh) 舵轮控制系统、方法、装置、计算机设备和agv车
EP2618943A1 (en) Apparatus and method for treatment of structural parts

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
GR01 Patent grant