CN103292806B - 一种适合agv的磁导航***和导航方法 - Google Patents
一种适合agv的磁导航***和导航方法 Download PDFInfo
- Publication number
- CN103292806B CN103292806B CN201310207596.8A CN201310207596A CN103292806B CN 103292806 B CN103292806 B CN 103292806B CN 201310207596 A CN201310207596 A CN 201310207596A CN 103292806 B CN103292806 B CN 103292806B
- Authority
- CN
- China
- Prior art keywords
- agv
- state
- magnetic
- line walking
- magnetic sensor
- 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
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种适合AGV的磁导航***和导航方法,所述***包括传感器模块、磁传感器信号采集模块、巡线主板模块;磁传感器信号采集模块的传感器阵列呈三行五列的形式排列,磁传感器信号采集模块采集各传感器的TTL电平信号,编码成规定16进制协议形式,并转化为232电平信号传给巡线主板模块进行分析后得到AGV当前巡线状态,根据巡线状态进行AGV左右轮差速调整,同时将AGV巡线状态和路口检测结果报告给上位机。本发明导航速度高,摆动幅度较小,能较好的控制AGV的运行轨迹,并能应用于多种类型路口。
Description
技术领域
本技术涉及磁导航领域,尤其涉及一种适合AGV的磁导航***和导航方法。
背景技术
目前以磁条方式导航的流转设备在现代自动化程度较高的生产线上应用极为普遍,如AGV(自动引导小车)、自动手推车AGC、无轨移动货架等。作为自动引导,巡线和路口检测在AGV控制中显得至关重要。
目前行业内的磁导航方式也是各式各样,各有各的特点,有单排模拟的、有单排数字的。单排的优点是设计简单,成本较低,缺点却很明显:一是检测精度很低,只有当设备运行过程偏移量较多的时候很多才能检测出来知道,信息传输滞后;二是能检测的路口种类不多,限制了应用范围。如果能开发出一种精度高且能检测多种类型路口的磁导航***及对应的导航方法,将是十分有意义的。
发明内容
为了解决上述问题,本发明提出了一种适合AGV的磁导航***和导航方法,
该***包括磁传感器模块,其特征在于,还包括磁传感器信号采集模块,巡线主板模块;其中
磁传感器模块由15个按照3行5列方式排列的磁传感器组成;
磁传感器信号采集模块包括:
信号采集单元:与磁传感器模块连接,用于采集TTL数据;
信号编码单元:用于对TTL信号进行编码;
电平转换和通信单元:用于将TTL信号转化为RS232电平传输至巡线主板模块。
巡线主板模块包括:
信号解码单元:与磁传感器信号采集模块连接,用于接收RS232电平信号,进行解码得到阵列中每个传感器的状态;
状态分析单元:用于分析AGV当前巡线状态和状态偏差趋势;
巡线算法与执行单元:用于计算并输出AGV左右轮的差速;
差速调整单元:用于将AGV左右轮的差速转为PWM的占空比,以调整电机的速度;
路口检测单元:用于检测路口类型;
通信单元:用于将AGV巡线的状态,如离线状态、差速状态等通过RS232上报上位机。
使用上述***的导航方法,包含以下步骤:
步骤1:采集磁传感器模块的TTL电平信号;
步骤2:磁传感器信号采集模块将TTL电平信号转化为RS232电平信号传输给巡线主板模块;
步骤3:巡线主板模块对信号进行解码后分析得到表示AGV当前行进状态的状态码;
步骤4:巡线主板模块根据得到的状态码,得到AGV左右电机速度的差值;
步骤5:差速调整单元将AGV左右电机速度的差值转为PWM的占空比,调整左右电机的速度;
步骤6:路口检测单元根据状态分析单元的状态得到路口种类状态;
步骤7:通信单元将巡线的状态通过RS232上报上位机。
本发明导航速度高,摆动幅度较小,能较好的控制AGV的运行轨迹,并能应用于多种类型路口。
附图说明
图1为本发明中磁传感器模块矩阵排列示意图。
图2为本发明***结构示意图。
图中:1.导航磁条。
具体实施方式
下面对本发明作进一步的说明。
本发明***主要包含三个模块:磁传感器阵列模块,磁传感器采集模块,巡线主板模块。
磁传感器阵列模块,磁传感器模块由15个按照3行5列方式排列的磁传感器组成;
与现有技术不同,本发明的磁传感器模块没有采用传统的单排磁传感器阵列(如图1所示,圆圈均代表磁导航传感单元,虚线框表示摆正位置),而是采用了如图1所示的阵列(图1中15个小圆圈代表15个磁导航传感单元),阵列按照3行5列方式排列。
第二列与第三列、第四列与第三列的间距相等,为L1;第一列与第二列,第四列与第五列间距相等,为L2;行间距为H。L1略大于铺在地面的导航磁条1宽度,作为微调;L2为1.5L1,作为大调,H为1.5L1,之所以设计H为1.5L1是为了适应不同种类的路口。L1根据巡线传感器的安装位置、AGV速度等计算出来的
使用本发明时第三列或者第二行竖直方向的投影位置位于导航磁条1线上,表明摆正。
采用本发明可以检测“+”字、“T”字、“土”字、“工”字等路口,这样大大增加路口的丰富性。如表1所示:
表1
其中,0表示位于导航磁条线1上的传感器输出TTL电平为低,1表示不位于导航磁条线1上的传感器输出TTL电平为高。
采用此种阵列形式大大提高了导航时磁导航传感器对AGV路线偏移的检测精度,并且适用于更多的路口种类。
磁传感器信号采集模块:
该模块包括顺次连接的信号采集单元、信号编码单元、电平转换和通信单元。
信号采集单元: 与磁传感器模块连接,功能为采集TTL数据,便于下一步编码。
信号编码单元: 用于对TTL信号进行编码。
电平转换和通信单元: 用于将TTL信号转化为RS232电平传输至巡线主板模块。
巡线主板模块:
该模块包括顺次连接的信号解码单元、状态分析单元、巡线算法与执行单元、差速调整单元、通信单元。
信号解码单元: 与磁传感器信号采集模块连接,用于解码磁传感器采集模块传输过来的RS232数据,得到每个传感器的状态。
状态分析单元: 功能为分析解码后的状态。首先记忆当前时刻状态并赋给上一时刻状态,得出当前状态和状态偏差趋势。
巡线算法与执行单元: 该单元为整个***的核心功能单元。功能是通过当前状态和状态偏差趋势计算AGV左右轮的差速。
差速调整单元:用于为将巡线算法与执行单元得到的差速输出转为PWM的占空比,以调整电机的速度。
路口检测单元:用于检测路口类型;
通信单元:用于将巡线的状态,如离线状态、差速状态等等通过RS232上报上位机。
下面对上述***的导航方法进行详细说明:
步骤1: 采集磁传感器的TTL电平信号。
具体为:磁传感器阵列模块采集阵列上15路传感器的TTL电平信号。
步骤2: 磁传感器信号采集模块将TTL电平信号转化为RS232电平信号传输给巡线主板模块。
具体为:信号编码单元按照行列关系将将15路TTL信号进行16进制编码成为3个字节协议形式,电平转换和通信单元通过电平转换芯片将其转化为RS232电平信号传给上传给巡线主板模块。
步骤3:巡线主板模块对信号进行解码后分析得到当前状态码。
具体为:信号解码单元开启一个定时器,不停地发送查询协议去查询传感器的状态(查询周期至少小于AGV以最高速度经过导航磁条线宽时间的2倍),要求查收呈严格时序,当接收传感器RS232串行数据的协议后,对其进行解析其是否合法,如果合法则解码得到代表传感器阵列的矩阵每个单元的值,根据矩阵状态在巡线状态码对应表(表2)中找到对应的状态码。
表2
注:表2左边第一列表示代表传感器阵列的矩阵, 0表示位于导航磁条1线上的传感器输出的低电平,1表示不位于导航磁条1线上的传感器输出的高电平。
当然,状态码只是一种描述偏离摆正状态的量化方法,所以并不唯一。只是有些状态虽然偏离导航磁条1线较远,但是其偏差角度却很小,这时状态码就不需要太大,因为这时的对AGV左右轮的差速要求并不大,只是要求两者的基础速度都较快,而某些偏差角度大的可以直接将状态码设置大点这样便于及时纠正;对于离线时的状态码,因为左离线和右离线的状态是一样的(左离线和右离线时各个传感器的输出均为高电平),但是它们的上一时刻肯定不一样,因此需要根据上一时刻的状态来确定状态码,当然这样的状态可以适当取大点;如果多次采样仍然处于离线状态,这状态码需要自动增加,这样加大输入偏差,利于及时调整。
步骤4:巡线算法与执行单元将状态分析单元得到的状态码,得到左右电机速度的差值。
具体为:状态码将作为控制算法的输入,作为AGV自动巡线控制***,要求摆动幅度不能太大、巡线精度较高、速度较快、能巡曲率较大的线,也就是对于自动控制***而言,希望该***的超调量小、静态误差小、动态响应快,但是这些要求有些本身就是矛盾,那么经过试验选择PID作为控制,经过整定的系数满足要求.
对于状态码摆正为0,左偏为负,右偏为正;把当前状态码偏差和偏差的偏差作为输入 (偏差的偏差是AGV这一时刻与上一时刻的状态码差值减去上一时刻与上上时刻的状态码差值所得) ,首先通过仿真和分析得到PID 参数的一个范围,对于AGV控制***,是一种典型伺服机电控制***,这样可以抽象理解为一阶惯性***,因此可以知道大概一个P、I、D系数范围。由于AGV巡线偏差主要由巡线曲率引起,而曲率是随机和不稳定的,因此就控制***而言,干扰是随机的阶跃激励,且幅值随机,故静态偏差是一直存在的,因此I必须存在,所以可以把输入偏差做一定平滑,对于控制***要求超调量不能太大,不然会导致过大摆动幅度,所以要求D系数要大于I 系数结合实际确定。这里PID算法由于在单片机里进行,因此采用增量式PID,且采用整形数据运算,最通过右移得到小数运算。另外需要强调的是调整频率,首先是采样频率,经过采样频率大于计算处理、电机的执行频率,这里以最高采样频率为更新频率,而采样频率满足大于最高速度更新线宽频率两倍以上。如果由于干扰太大,一直在一定数量的周期内还处于离线状态,这停止当做离线故障处理。
步骤5:差速调整单元将巡线算法与执行单元得到的差,分别加减给左右电机速度控制上,继而转为PWM(Pulse Width Modulation 脉冲宽度调制)的差值以改变占空比,最终调整电机的速度
步骤6:路口检测单元根据状态分析单元的状态查表得到路口类型,如表1所示。
当然实际中,路口传感器状态并非如表所述那么标准,因此需要对边缘一些状态做一定容错,这会大大增加路口检测频率。
步骤7: 通信单元将巡线的状态,如离线状态、差速状态等等通过RS232上报上位机。
经试验和产品运行反馈,本发明的优点有以下几点:
1.导航速度角度较高,最高可达0.6m/s,
2.摆动幅度较小,AGV车身小于3度,
3.在一定干扰下,可以在小于10个周期内返回线上,
4.在局部出现磁条损坏下,仍可巡线,
5.在有很厚的东西盖住磁条,AGV仍可以巡线,
6.路口检测率高达99%。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种适合AGV的磁导航***的导航方法,其特征在于,所述适合AGV的磁导航***,包括磁传感器模块,还包括磁传感器信号采集模块,巡线主板模块;其中
磁传感器模块由15个按照3行5列方式排列的磁传感器组成;
磁传感器信号采集模块包括:
信号采集单元:与磁传感器模块连接,用于采集TTL数据;
信号编码单元:用于对TTL信号进行编码;
电平转换和通信单元:用于将TTL信号转化为RS232电平传输至巡线主板模块;
巡线主板模块包括:
信号解码单元:与磁传感器信号采集模块连接,用于接收RS232电平信号,进行解码得到阵列中每个传感器的状态;
状态分析单元:用于分析AGV当前巡线状态和状态偏差趋势;
巡线算法与执行单元:用于计算并输出AGV左右轮的差速;
差速调整单元:用于将AGV左右轮的差速转为PWM的占空比,以调整电机的速度;
路口检测单元:用于检测路口类型;
通信单元:用于将AGV巡线的状态通过RS232上报上位机;
上述适合AGV的磁导航***的导航方法包含以下步骤:
步骤1:采集磁传感器模块的TTL电平信号;
步骤2:磁传感器信号采集模块将TTL电平信号转化为RS232电平信号传输给巡线主板模块;
步骤3:巡线主板模块对信号进行解码后分析得到表示AGV当前行进状态的状态码;
步骤4:巡线主板模块根据得到的状态码,得到AGV左右电机速度的差值;
步骤5:差速调整单元将AGV左右电机速度的差值转为PWM的占空比,调整左右电机的速度;
步骤6:路口检测单元根据状态分析单元的状态得到路口种类状态;
步骤7:通信单元将巡线的状态通过RS232上报上位机。
2. 一种如权利要求1所述的一种适合AGV的磁导航***的导航方法,其特征在于:步骤2中,磁传感器信号采集模块的信号编码单元,按照磁传感器模块传感器阵列的行列关系将15路TTL信号进行16进制编码成为3个字节后转化为RS232电平信号。
3.一种如权利要求1所述的一种适合AGV的磁导航***的导航方法,其特征在于:步骤3中,磁传感器信号采集模块的信号解码单元开启一个定时器,不停地发送查询协议去查询传感器的状态,当接收RS232电平信号,对其进行解析其是否合法,如果合法则解码得到代表传感器阵列的矩阵每个单元的值。
4.一种如权利要求1所述的一种适合AGV的磁导航***的导航方法,其特征在于:步骤3中,当AGV完全脱离导航磁条(1)时,属于离线状态,因为左离线和右离线的状态是一样的,但上一时刻状态不一样,因此需要根据上一时刻的状态来确定状态码。
5.一种如权利要求1所述的一种适合AGV的磁导航***的导航方法,其特征在于:步骤4中,采用PID算法,把当前状态码偏差和偏差的偏差作为输入,通过仿真和分析得到PID 参数的一个范围, I必须存在,D系数要大于I 系数。
6.一种如权利要求1所述的一种适合AGV的磁导航***的导航方法,其特征在于:步骤6中,可对传感器阵列边缘传感器单元的状态增加容错,以增加路口检测频率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310207596.8A CN103292806B (zh) | 2013-05-30 | 2013-05-30 | 一种适合agv的磁导航***和导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310207596.8A CN103292806B (zh) | 2013-05-30 | 2013-05-30 | 一种适合agv的磁导航***和导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103292806A CN103292806A (zh) | 2013-09-11 |
CN103292806B true CN103292806B (zh) | 2015-08-19 |
Family
ID=49094065
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310207596.8A Active CN103292806B (zh) | 2013-05-30 | 2013-05-30 | 一种适合agv的磁导航***和导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103292806B (zh) |
Families Citing this family (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104102217B (zh) * | 2014-07-14 | 2017-01-11 | 上海海事大学 | 一种用于运载车行驶状态检测***及方法 |
CN104536441B (zh) * | 2014-12-13 | 2018-04-24 | 河南勃达微波设备有限责任公司 | 金刚石干燥筛分自动生产*** |
CN106403931A (zh) * | 2015-07-31 | 2017-02-15 | 北京航天计量测试技术研究所 | 一种磁地标动态定位方法 |
CN105278530B (zh) * | 2015-09-16 | 2017-12-29 | 成都四威高科技产业园有限公司 | 一种磁条信号容错纠错处理方法和*** |
CN105824315B (zh) * | 2016-04-27 | 2019-06-14 | 武汉艾立奇自动化科技有限公司 | 一种agv自动引导***及其方法 |
CN106292664B (zh) * | 2016-08-17 | 2019-07-12 | 国网山东省电力公司电力科学研究院 | 一种变电站巡检机器人导航控制***及方法 |
CN106527443B (zh) * | 2016-11-27 | 2019-06-18 | 北京特种机械研究所 | 全向移动agv导航纠偏方法 |
CN106679654A (zh) * | 2017-01-06 | 2017-05-17 | 南京理工大学 | 一种agv用磁导航传感器 |
CN106873594A (zh) * | 2017-03-08 | 2017-06-20 | 苏州易摩物联科技有限公司 | Agv磁导航运行控制方法及*** |
CN106843233B (zh) * | 2017-03-30 | 2023-04-18 | 安徽国购机器人产业控股有限公司 | 一种基于磁导航传感器的移动机器人 |
CN107219853B (zh) * | 2017-07-10 | 2023-10-20 | 张德雨 | 一种基于机器人的开放式自动化导航方法及*** |
CN107270887B (zh) * | 2017-07-13 | 2020-10-27 | 青岛海通胜行智能科技有限公司 | 一种基于无线和磁场感应技术相结合的定位方法 |
CN109426251B (zh) * | 2017-08-29 | 2020-11-06 | 杭州海康机器人技术有限公司 | 一种机器人的行驶控制方法和装置 |
WO2019063594A1 (fr) * | 2017-09-29 | 2019-04-04 | Continental Automotive Gmbh | Capteur de vilebrequin, de transmission ou d'arbre à cames, système et procédé de diagnostic mettant en œuvre un tel capteur |
FR3071921A1 (fr) * | 2017-09-29 | 2019-04-05 | Continental Automotive France | Capteur de vilebrequin, de transmission ou d'arbre a cames, systeme et procede de diagnostic mettant en œuvre un tel capteur |
CN109814567B (zh) * | 2019-02-01 | 2020-07-21 | 珠海启明文化传播有限公司 | 无人驾驶***及其工作方法 |
CN110209164B (zh) * | 2019-05-20 | 2022-09-27 | 江苏理工学院 | 一种agv小车线性霍尔导引装置及其导引方法 |
CN112550289B (zh) * | 2020-12-10 | 2022-04-05 | 珠海格力智能装备有限公司 | 自主导航车辆的轨迹纠偏方法及轨迹纠偏装置、车辆控制*** |
CN113009920A (zh) * | 2021-03-09 | 2021-06-22 | 河南牧原智能科技有限公司 | 一种移动机器人导航控制方法及*** |
CN114234957B (zh) * | 2021-10-21 | 2024-07-23 | 湖南湖大艾盛汽车技术开发有限公司 | 一种基于磁条导航数据码的节点识别方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1274876A (zh) * | 1999-05-25 | 2000-11-29 | 李善伯 | 构成计算机管理下地面磁性航线、信标及传感器安装的方法 |
CN1928499A (zh) * | 2006-09-28 | 2007-03-14 | 上海交通大学 | 无人驾驶车辆的磁引导装置 |
CN101561680A (zh) * | 2009-05-11 | 2009-10-21 | 南京航空航天大学 | 一种自主车辆的嵌入式导引装置及其智能复合导引方法 |
CN102147259A (zh) * | 2011-01-14 | 2011-08-10 | 南京航空航天大学 | 环形阵列磁导引装置及其导引磁标识别方法 |
CN102356367A (zh) * | 2009-01-17 | 2012-02-15 | 布穆朗***有限公司 | 用于增强自动导引车导引性能的可变偏移定位天线阵列 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3482463B2 (ja) * | 2000-12-15 | 2003-12-22 | 矢崎化工株式会社 | 潜行型の誘導式牽引車 |
-
2013
- 2013-05-30 CN CN201310207596.8A patent/CN103292806B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1274876A (zh) * | 1999-05-25 | 2000-11-29 | 李善伯 | 构成计算机管理下地面磁性航线、信标及传感器安装的方法 |
CN1928499A (zh) * | 2006-09-28 | 2007-03-14 | 上海交通大学 | 无人驾驶车辆的磁引导装置 |
CN102356367A (zh) * | 2009-01-17 | 2012-02-15 | 布穆朗***有限公司 | 用于增强自动导引车导引性能的可变偏移定位天线阵列 |
CN101561680A (zh) * | 2009-05-11 | 2009-10-21 | 南京航空航天大学 | 一种自主车辆的嵌入式导引装置及其智能复合导引方法 |
CN102147259A (zh) * | 2011-01-14 | 2011-08-10 | 南京航空航天大学 | 环形阵列磁导引装置及其导引磁标识别方法 |
Non-Patent Citations (2)
Title |
---|
Research on the AGV Based Robot System Used in Substation Inspection;Li Shengfang等;《2006 International Conference on Power System Technology 》;20061231;第1-4页 * |
移载式磁导航AGV关键技术研究;周驰东等;《工业控制计算机》;20121231;第25卷(第1期);第4-5页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103292806A (zh) | 2013-09-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103292806B (zh) | 一种适合agv的磁导航***和导航方法 | |
CN101758422B (zh) | 一种数控装置技术指标的检测分析装置 | |
CN104122895B (zh) | 一种基于自适应pid的agv导航方法 | |
CN203881354U (zh) | 复合型编码器 | |
CN205175428U (zh) | 一种具有双通道旋转变压器的位置检测及解码电路 | |
CN105823504A (zh) | 一种编码器的越零点处理方法 | |
CN110108306A (zh) | Agv小车的物理参数校核方法以及agv小车 | |
CN107799194A (zh) | 智能棒位阈值整定及性能鉴定方法 | |
CN108444506A (zh) | 编码器码盘、绝对值编码器、位置获取方法及*** | |
CN105278530A (zh) | 一种磁条信号容错纠错处理方法和*** | |
CN103760921B (zh) | 低精度多个传感器融合的原点精确定位***及定位方法 | |
CN210165982U (zh) | 一种用于磁编码器的矫正装置 | |
CN204883407U (zh) | 一种伺服压力控制*** | |
CN201607238U (zh) | 一种智能光电直读器 | |
CN109282833B (zh) | 垂线坐标仪自动化标定装置及其标定方法 | |
CN103837115B (zh) | 三维姿态测算方法及装置 | |
CN103604447A (zh) | 一种高分辨率增量型总线式光电编码器的实现方法 | |
CN109990823A (zh) | 用于检测光电编码器精度的检测装置及检测方法 | |
CN202004710U (zh) | 采用电子传动比的交流伺服控制器 | |
CN209857935U (zh) | 用于检测光电编码器精度的检测装置 | |
CN205843684U (zh) | 一种基于二维数控滑台的运动轨迹记录装置 | |
CN104991582A (zh) | 一种伺服压力控制*** | |
CN104655156A (zh) | 一种矩阵式编码方式的绝对式码盘的误差补偿方法 | |
CN102126547B (zh) | 舵角采集方法、装置及*** | |
CN109855661A (zh) | 一种增量式编码器信号处理方法和*** |
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 |