一种自动循迹识别指示系统及其指示方法.pdf

上传人:b*** 文档编号:4337230 上传时间:2018-09-15 格式:PDF 页数:23 大小:1.72MB
返回 下载 相关 举报
摘要
申请专利号:

CN201510093010.9

申请日:

2015.03.02

公开号:

CN104679006A

公开日:

2015.06.03

当前法律状态:

授权

有效性:

有权

法律详情:

授权|||实质审查的生效IPC(主分类):G05D 1/02申请日:20150302|||公开

IPC分类号:

G05D1/02

主分类号:

G05D1/02

申请人:

鲍驭浩; 鲍旭东

发明人:

鲍驭浩; 鲍旭东

地址:

315700浙江省象山县丹城镇梅苑小区40幢1-102室

优先权:

专利代理机构:

宁波诚源专利事务所有限公司33102

代理人:

张一平

PDF下载: PDF下载
内容摘要

本发明涉及一种自动循迹识别指示系统,包括用于为移动装置提供指示信息的指示块单元,用于检测指示块单元上指示信息的指示块检测单元,为移动装置提供路径指示的控制器。该自动循迹识别指示系统结构简单、识别处理速度快。本发明还涉及一种自动循迹识别指示系统的指示方法,该指示方法能够自各种复杂程度的循迹路径中指示移动装置快速准确到达任一指定目的工位位置。

权利要求书

权利要求书
1.  一种自动循迹识别指示系统,用于给移动装置提供路径指示,其特征在于:包 括
指示块单元(1),设置在循迹路径上,用于给移动装置提供指示信息;
指示块检测单元(2),所述指示块检测单元(2)设置于移动装置上,能够检测到前述 指示块单元(1)的指示信息;
控制器(4),与所述指示块检测单元(2)和移动装置连接,根据指示块检测单元(2)检 测到的指示信息,给移动装置提供路径指示。

2.  根据权利要求1所述的自动循迹识别指示系统,其特征在于:根据不同复杂程 度的循迹路径,所述指示块单元(1)包括有不同种类的指示块,所述指示块检测单元(2) 能够从所述不同种类的指示块中获取相应的前进方向、减速距离和/或转向指示信息;
所述自动循迹识别指示系统还包括有与所述控制器(4)通讯连接的指示编码单元 (3),所述指示编码单元(3)中存储有各个目标工位的循迹路径编码,每个循迹路径编码 中包含有自起点到达该目标工位的循迹路径中、需要检测到的各种指示块的总数及需要 的指示块的转向参数。

3.  根据权利要求2所述的自动循迹识别指示系统,其特征在于:所述指示块单元 (1)包括:
主干道指示块(11),所述主干道指示块(11)设置在循迹路径中主干道转入支道的路 口,用于给移动装置在循迹路径的主干道上的移动提供指示信息;
支道指示块(12),所述支道指示块(12)设置在循迹路径中支道转入支道和支道转入 主干道的路口,用于给移动装置在循迹路径的支道上的移动提供指示信息;
工位节点指示块(13),所述工位节点指示块(13)分别设置在循迹路径中距离目标工 位最近的路口上,用于给移动装置靠近目标工位提供指示信息;
目标工位停止指示块(14),所述目标工位停止指示块(14)设置在目标工位位置,用 于给移动装置到达目标工位位置提供指示信息;
起点停止指示块(15),所述起点停止指示块(15)设置在循迹路径的返回路径上,并 设置于起点位置,用于给移动装置到达起点位置提供指示信息。

4.  根据权利要求3所述的自动循迹识别指示系统,其特征在于:所述指示编码单 元中每个目标工位的循迹路径编码包括至少一组用于指示自起点到达该目标工位的目 标数据组;
所述目标数据组中包括:
主干道指示数据位,所述主干道指示数据位中存储有自起点到达目标工位的循迹路 径中需要经过的主干道指示块的总量;
支道指示数据位,所述支道指示数据位中存储有自起点到达目标工位的循迹路径中 需要经过的支道指示块的总量;
工位节点指示数据位,所述工位节点指示数据位中存储有自起点到达目标工位的循 迹路径中需要经过的工位节点指示块的总量;
其中在循迹路径中的第一个支道指示块位置不需要转弯的情况下,支道指示数据位 存入数据“0”;
所述主干道指示块(11)分别设置在循迹路径主干道路口的左侧位置或者右侧位置, 以供指示块检测单元(2)检测从而获取相对应的向左转向或者向右转向的转向指示信息; 或者所述目标数据组中还包括有主干道方向指示数据位,所述主干道方向指示数据位中 存储有自起点到达目标工位的循迹路径中、最后一个主干道指示块(11)位置的转向参数;
所述支道指示块(12)分别设置在循迹路径支道路口左侧位置或者右侧位置,以供指 示块检测单元(2)检测从而获取相对应的向左转向或者向右转向的转向指示信息;或者所 述目标数据组中还包括有支道方向指示数据位,所述支道方向指示数据位中存储有自起 点到达目标工位的循迹路径中、经过的第一个支道指示块(12)位置和最后一个支道指示 块(12)位置的转向参数;
所述工位节点指示块(13)分别设置在循迹路径中距离目标工位最近的路口的左侧位 置或者右侧位置,以供指示块检测单元(2)检测从而获取相对应的向左转向或者向右转向 的转向指示信息;或者所述目标数据组中还包括有工位节点方向指示数据位,所述工位 节点方向指示数据位中存储有自起点到达目标工位的循迹路径中、最后一个工位节点位 置至目标工位位置的转向参数。

5.  根据权利要求4所述的自动循迹识别指示系统,其特征在于:所述指示编码单 元中每个目标工位的循迹路径编码还包括一组用于指示自目标工位到达起点的返回数 据组,所述返回数据组中存储有自目标工位到达起点的循迹路径中、各个支道指示块(12) 位置对应的转向参数。

6.  根据权利要求2~5任一权利要求所述的自动循迹识别指示系统,其特征在于: 所述指示块检测单元(2)包括编码器、解码器及分别左右安装在移动装置底部的两组红外 线传感器集阵;
所述不同种类的指示块分别设置为能够被红外线传感器集阵检测并区分的反光色 块。

7.  一种如权利要求2~5任一权利要求所述的自动循迹识别指示系统的指示方法: 包括如下步骤:
步骤一、根据循迹路径的规划及各种指示块能够提供的指示信息,在主干道的各路 口、支道各路口、工位节点、目标工位、起点的相应位置分别设置对应的指示块;
步骤二、根据循迹路径及各指示块的设置情况,对所述指示编码单元(3)进行编码, 从而形成各目标工位的循迹路径编码;
步骤三、根据所述指示编码单元(3)中各目标工位的循迹路径编码,在所述控制器(4) 中初始化当次目标工位的循迹路径编码,即将当次目标工位相对应地的目标数据组存入 到控制器(4)中;
步骤四、启动移动装置,在移动装置向目标工位行进的循迹路径中,利用所述指示 块检测单元(2)检测循迹路径中各路口设置的指示块,并将自指示块检测获取到的指示信 息传送到所述控制器(4)中,此时,所述控制器(4)接收指示块检测单元(2)传送的指示信 息并对各种指示块的数量进行累积计数,同时所述控制器(4)将各种指示块的累积数据与 目标数据组中的数据进行比对;
所述控制器(4)向移动装置发送直行的指示控制命令直至主干道指示块(11)的累积计 数等于目标数据组中主干道指示数据位上的数据,此时,所述指示块检测单元(2)将自最 后一个主干道指示块(11)上获取的前进方向、减速距离指示信息传送给控制器(4);
所述指示块检测单元(2)根据检测到的最后一个主干道指示块(11)的设置位置获取其 转向指示信息并将该转向信息传送给所述控制器(4),从而控制器(4)根据获取的前进方 向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器(4) 的指示控制减速停止后再转入支道;或者所述控制器(4)读取主干道方向指示数据位中存 储的转向参数从而获取转向指示信息,并根据获取的前进方向、减速距离、转向指示信 息向移动装置发送指示控制命令,移动装置按照控制器(4)的指示控制减速停止后再转入 支道;
当目标数据组中支道指示数据位上的数据为“0”时,则控制器(4)向移动装置发送 直行的指示控制命令直至工位节点指示块(13)的累积计数等于目标数据组中工位节点指 示数据位上的数据,此时,所述指示块检测单元(2)将自最后一个工位节点指示块(13)上 获取的前进方向、减速距离指示信息传送给控制器(4);
所述指示块检测单元(2)根据检测到的最后一个工位节点指示块(13)的设置位置获 取其转向指示信息并将该转向信息传送给所述控制器(4),从而控制器(4)根据获取的前 进方向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器 (4)的指示控制减速停止后再转向目标工位位置;或者所述控制器(4)读取工位节点方向 指示数据位中存储的转向参数从而获取转向指示信息,并根据获取的前进方向、减速距 离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器(4)的指示控制减 速停止后再转向目标工位位置;
所述控制器(4)控制移动装置向目标工位位置直行直至所述指示块检测单元(2)检测 到目标工位停止指示块(14),此时,所述指示块检测单元(2)将自目标工位停止指示块(14) 上获取的减速距离和停止指示信息传送给控制器(4),控制器(4)根据指示信息向移动装 置发送指示控制命令,从而使得移动装置减速并最终停止在目标工位上;
当目标数据组中第二数据位上的数据不为“0”时,则控制器(4)向移动装置发送直 行的指示控制命令直至指示块检测单元(2)检测到第一个支道指示块(12),此时,所述指 示块检测单元(2)将自第一个支道指示块(12)上获取的前进方向、减速距离指示信息传送 给控制器(4);
所述指示块检测单元(2)根据检测到的第一个支道指示块(12)的设置位置获取其转 向指示信息并将该转向信息传送给所述控制器(4),从而控制器(4)根据获取的前进方向、 减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器(4)的指示 控制减速停止后再转向移动;或者所述控制器(4)读取支道方向指示数据位中存储的第一 个支道指示块(12)位置的转向参数从而获取转向指示信息,并根据获取的前进方向、减 速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器(4)的指示控 制减速停止后再转向移动;
移动装置根据指示控制命令转向后,在控制器(4)的指示控制下保持直行直至指示块 检测单元(2)检测到的支道指示块(12)的累积计数等于目标数据组中支道指示数据位上 的数据,此时,所述指示块检测单元(2)将自最后一个支道指示块(12)上获取的前进方向、 减速距离指示信息传送给控制器(4);
所述指示块检测单元(2)根据检测到的最后一个支道指示块(12)的设置位置获取其 转向指示信息并将该转向信息传送给所述控制器(4),从而控制器(4)根据获取的前进方 向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器(4) 的指示控制减速停止后再转向移动;或者所述控制器(4)读取支道方向指示数据位中存储 的最后一个支道指示块(12)位置的转向参数从而获取转向指示信息,并根据获取的前进 方向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器(4) 的指示控制减速停止后再转向移动;
移动装置根据指示控制命令转向后,在控制器(4)的指示控制下保持直行直至指示块 检测单元(2)检测到的工位节点指示块(13)的累积计数等于目标数据组中工位节点指示 数据位上的数据,此时,所述指示块检测单元(2)将自最后一个工位节点指示块(13)上获 取的前进方向、减速距离指示信息传送给控制器(4);
所述指示块检测单元(2)根据检测到的最后一个工位节点指示块(13)的设置位置获 取其转向指示信息并将该转向信息传送给所述控制器(4),从而控制器(4)根据获取的前 进方向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器 (4)的指示控制减速停止后再转向移动;或者所述控制器(4)读取工位节点方向指示数据 位中存储的转向参数从而获取转向指示信息,并根据获取的前进方向、减速距离、转向 指示信息向移动装置发送指示控制命令,移动装置按照控制器(4)的指示控制减速停止后 再转向目标工位位置;
所述控制器(4)控制移动装置向目标工位位置直行直至所述指示块检测单元(2)检测 到目标工位停止指示块(14),此时,所述指示块检测单元(2)将自目标工位停止指示块(14) 上获取的减速距离和停止指示信息传送给控制器(4),控制器(4)根据指示信息向移动装 置发送指示控制命令,从而使得移动装置减速并最终停止在目标工位上;
步骤五、移动装置在目标工位完成工作后返回起点,在返回过程中,所述指示块检 测单元(2)检测循迹路径中自目标工位至起点的返回路径上的支道指示块(12),从而获取 返回路径上每个支道指示块(12)上的前进方向、减速距离指示信息并传送给控制器(4);
所述指示块检测单元(2)根据检测到的每个支道指示块(12)的设置位置,以获取每个 支道指示块(12)位置的转向指示信息并将该转向信息传送给所述控制器(4),从而控制器 (4)根据获取的前进方向、减速距离、转向指示信息向移动装置发送指示控制命令,移动 装置按照控制器(4)的指示控制在每个支道指示块(12)位置减速停止后再转向移动;或者 所述控制器(4)读取返回数据组中存储的各个支道指示块(12)对应的转向参数从而获取 转向指示信息,并根据获取的前进方向、减速距离、转向指示信息向移动装置发送指示 控制命令,移动装置按照控制器(4)的指示控制减速停止后再转向移动;
所述控制器(4)指示控制移动装置最终转入循迹路径中返回路径的主干道上,并返回 到起点;
步骤六、所述指示块检测单元(2)检测到起点停止指示块(15)后,将自起点停止指示 块(15)上获取的减速距离和停止指示信息传送给控制器(4),控制器(4)根据指示信息向移 动装置发送指示控制命令,从而使得移动装置减速并最终停止在起点位置;
步骤七、清除所述控制器(4)中的计数及当次的循迹路径编码,并等待进入步骤三。

8.  根据权利要求6所述的自动循迹识别指示系统的指示方法,其特征在于:所述 步骤二中,根据循迹路径及各指示块的设置情况,统计自起点到达各目标位置的循迹路 径中最优路径需要经过的主干道指示块(11)的数量、支道指示块(12)数量、工位节点指示 块(13)数量,同时确定需要的各指示块位置对应的转向参数,从而将相应的数据分别填 入各目标工位的目标数据组的各个数据位中,进而形成各目标工位的循迹路径编码。

说明书

说明书一种自动循迹识别指示系统及其指示方法
技术领域
本发明涉及自动循迹控制技术领域,特别涉及自动循迹复杂路径的识别指示系统, 本发明还涉及一种该自动循迹识别指示系统的指示方法。
背景技术
智能移动装置自动循迹移动常用的循迹方式有:GPS导航、电磁感应导航、惯性导 航、视觉导航、预制坐标导航、光电反射导航、磁带导航等,这些导航都无法对如大型 超市货架、大型工厂工作区等复杂场所进行精确导航循迹,因为这些场所到达每个工位 的导航轨迹很复杂,有很多交叉线、转弯线,有时到达一个工位需要经过10多个路口, 转10多个弯才能到达,每个路口有左转、右转、直行三种方式选择,能做到这些的, 往往系统非常复杂,价格昂贵,也因此很多智能移动装置无法大量推广。
如授权公告号CN201853137U(申请号为201020622590.9)的中国实用新型专利《基 于光电传感器的智能化自循迹小车控制系统》,其中公开的自循迹小车控制系统将光电 传感器和语音识别技术进行结合,以反射式红外光电传感器获取路径信息,根据路径信 息中黑线的位置调整小车的运动方向及速度,其路径信息中的指示不够详细完备,会增 加小车自循迹的难度,很难完成复杂路线的精确优化导航。
申请公布号为CN103226354A(申请号为201310062879.8)的中国发明专利申请《基 于光电导航的无人驾驶道路识别系统》,其中公开的无人驾驶道路识别系统需要使用视 觉模块和图像处理模块配合道路识别模块进行控制,其系统工作过程中需要处理大量的 图像的信息,相应的处理速度会大大降低,同时由于信息量大且复杂,对硬件的要求高, 大大提高了其使用成本。
发明内容
本发明所要解决的第一个技术问题是针对上述现有技术提供一种系统结构简单、识 别处理速度快的自动循迹识别指示系统。
本发明所要解决的第二个技术问题是针对上述现有技术提供一种利用自动循迹识 别指示系统能够在各种复杂程度的循迹路径指示移动装置快速准确到达任一指定目的 地的指示方法。
本发明解决上述第一个技术问题所采用的技术方案为:一种自动循迹识别指示系 统,用于给移动装置提供路径指示,其特征在于:包括
指示块单元,设置在循迹路径上,用于给移动装置提供指示信息;
指示块检测单元,所述指示块检测单元设置于移动装置上,能够检测到前述指示块 单元的指示信息;
控制器,与所述指示块检测单元和移动装置连接,根据指示块检测单元检测到的指 示信息,经过运算后,给移动装置提供路径指示。
为了实现在复杂循迹路径中的使用,根据不同复杂程度的循迹路径,所述指示块单 元包括有不同种类的指示块,所述指示块检测单元能够从所述不同种类的指示块中获取 相应的前进方向、减速距离和/或转向指示信息;
所述自动循迹识别指示系统还包括有与所述控制器通讯连接的指示编码单元,所述 指示编码单元中存储有各个目标工位的循迹路径编码,每个循迹路径编码中包含有自起 点到达该目标工位的循迹路径中、需要检测到的各种指示块的总数及需要的指示块的转 向参数。
为了更加清楚的指示目标工位位置,所述指示块单元包括:
主干道指示块,所述主干道指示块设置在循迹路径中主干道转入支道的路口,用于 给移动装置在循迹路径的主干道上的移动提供指示信息;
支道指示块,所述支道指示块设置在循迹路径中支道转入支道和支道转入主干道的 路口,用于给移动装置在循迹路径的支道上的移动提供指示信息;
工位节点指示块,所述工位节点指示块分别设置在循迹路径中距离目标工位最近的 路口上,用于给移动装置靠近目标工位提供指示信息;
目标工位停止指示块,所述目标工位停止指示块设置在目标工位位置,用于给移动 装置到达目标工位位置提供指示信息;
起点停止指示块,所述起点停止指示块设置在循迹路径的返回路径上,并设置于起 点位置,用于给移动装置到达起点位置提供指示信息。
为了能够方便准确的指示出目标工位,所述指示编码单元中每个目标工位的循迹路 径编码包括至少一组用于指示自起点到达该目标工位的目标数据组;
所述目标数据组中包括:
主干道指示数据位,所述主干道指示数据位中存储有自起点到达目标工位的循迹路 径中需要经过的主干道指示块的总量;
支道指示数据位,所述支道指示数据位中存储有自起点到达目标工位的循迹路径中 需要经过的支道指示块的总量;
工位节点指示数据位,所述工位节点指示数据位中存储有自起点到达目标工位的循 迹路径中需要经过的工位节点指示块的总量;
其中在循迹路径中的第一个支道指示块位置不需要转弯的情况下,支道指示数据位 存入数据“0”;
所述主干道指示块分别设置在循迹路径主干道路口的左侧位置或者右侧位置,以供 指示块检测单元检测从而获取相对应的向左转向或者向右转向的转向指示信息;或者所 述目标数据组中还包括有主干道方向指示数据位,所述主干道方向指示数据位中存储有 自起点到达目标工位的循迹路径中、最后一个主干道指示块位置的转向参数;
所述支道指示块分别设置在循迹路径支道路口左侧位置或者右侧位置,以供指示块 检测单元检测从而获取相对应的向左转向或者向右转向的转向指示信息;或者所述目标 数据组中还包括有支道方向指示数据位,所述支道方向指示数据位中存储有自起点到达 目标工位的循迹路径中、经过的第一个支道指示块位置和最后一个支道指示块位置的转 向参数;
所述工位节点指示块分别设置在循迹路径中距离目标工位最近的路口的左侧位置 或者右侧位置,以供指示块检测单元检测从而获取相对应的向左转向或者向右转向的转 向指示信息;或者所述目标数据组中还包括有工位节点方向指示数据位,所述工位节点 方向指示数据位中存储有自起点到达目标工位的循迹路径中、最后一个工位节点位置至 目标工位位置的转向参数。
作为改进,所述指示编码单元中每个目标工位的循迹路径编码还包括一组用于指示 自目标工位到达起点的返回数据组,所述返回数据组中存储有自目标工位到达起点的循 迹路径中、各个支道指示块(12)位置对应的转向参数。
优选地,所述指示块检测单元包括编码器、解码器及分别左右安装在移动装置底部 的两组红外线传感器集阵;
所述不同种类的指示块分别设置为能够被红外线传感器集阵检测并区分的反光色 块。
本发明解决上述第二个技术问题所采用的技术方案为:一种如前述的自动循迹识别 指示系统的指示方法:包括如下步骤:
步骤一、根据循迹路径的规划及各种指示块能够提供的指示信息,在主干道的各路 口、支道各路口、工位节点、目标工位、起点的相应位置分别设置对应的指示块;
步骤二、根据循迹路径及各指示块的设置情况,对所述指示编码单元进行编码,从 而形成各目标工位的循迹路径编码;
步骤三、根据所述指示编码单元中各目标工位的循迹路径编码,在所述控制器中初 始化当次目标工位的循迹路径编码,即将当次目标工位相对应地的目标数据组存入到控 制器中;
步骤四、启动移动装置,在移动装置向目标工位行进的循迹路径中,利用所述指示 块检测单元检测循迹路径中各路口设置的指示块,并将自指示块检测获取到的指示信息 传送到所述控制器中,所述控制器接收指示块检测单元传送的指示信息并对各种指示块 的数量进行累积计数,同时所述控制器将各种指示块的累积数据与目标数据组中的数据 进行比对;
所述控制器向移动装置发送直行的指示控制命令直至主干道指示块的累积计数等 于目标数据组中主干道指示数据位上的数据,此时,所述指示块检测单元将自最后一个 主干道指示块上获取的前进方向、减速距离指示信息传送给控制器;
所述指示块检测单元根据检测到的最后一个主干道指示块的设置位置获取其转向 指示信息并将该转向信息传送给所述控制器,从而控制器根据获取的前进方向、减速距 离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器的指示控制减速 停止后再转入支道;或者所述控制器读取主干道方向指示数据位中存储的转向参数从而 获取转向指示信息,并根据获取的前进方向、减速距离、转向指示信息向移动装置发送 指示控制命令,移动装置按照控制器的指示控制减速停止后再转入支道;
当目标数据组中支道指示数据位上的数据为“0”时,则控制器向移动装置发送直 行的指示控制命令直至工位节点指示块的累积计数等于目标数据组中工位节点指示数 据位上的数据,此时,所述指示块检测单元将自最后一个工位节点指示块上获取的前进 方向、减速距离指示信息传送给控制器;
所述指示块检测单元根据检测到的最后一个工位节点指示块的设置位置获取其转 向指示信息并将该转向信息传送给所述控制器,从而控制器根据获取的前进方向、减速 距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器的指示控制减 速停止后再转向目标工位位置;或者所述控制器读取工位节点方向指示数据位中存储的 转向参数从而获取转向指示信息,并根据获取的前进方向、减速距离、转向指示信息向 移动装置发送指示控制命令,移动装置按照控制器的指示控制减速停止后再转向目标工 位位置;
所述控制器控制移动装置向目标工位位置直行直至所述指示块检测单元检测到目 标工位停止指示块,所述指示块检测单元将自目标工位停止指示块上获取的减速距离和 停止指示信息传送给控制器,控制器根据指示信息向移动装置发送指示控制命令,从而 使得移动装置减速并最终停止在目标工位上;
当目标数据组中第二数据位上的数据不为“0”时,则控制器向移动装置发送直行 的指示控制命令直至指示块检测单元检测到第一个支道指示块,所述指示块检测单元将 自第一个支道指示块上获取的前进方向、减速距离指示信息传送给控制器;
所述指示块检测单元根据检测到的第一个支道指示块的设置位置获取其转向指示 信息并将该转向信息传送给所述控制器,从而控制器根据获取的前进方向、减速距离、 转向指示信息向移动装置发送指示控制命令,移动装置按照控制器的指示控制减速停止 后再转向移动;或者所述控制器读取支道方向指示数据位中存储的第一个支道指示块位 置的转向参数从而获取转向指示信息,并根据获取的前进方向、减速距离、转向指示信 息向移动装置发送指示控制命令,移动装置按照控制器的指示控制减速停止后再转向移 动;
移动装置根据指示控制命令转向后,在控制器的指示控制下保持直行直至指示块检 测单元检测到的支道指示块的累积计数等于目标数据组中支道指示数据位上的数据,所 述指示块检测单元将自最后一个支道指示块上获取的前进方向、减速距离指示信息传送 给控制器;
所述指示块检测单元根据检测到的最后一个支道指示块的设置位置获取其转向指 示信息并将该转向信息传送给所述控制器,从而控制器根据获取的前进方向、减速距离、 转向指示信息向移动装置发送指示控制命令,移动装置按照控制器的指示控制减速停止 后再转向移动;或者所述控制器读取支道方向指示数据位中存储的最后一个支道指示块 位置的转向参数从而获取转向指示信息,并根据获取的前进方向、减速距离、转向指示 信息向移动装置发送指示控制命令,移动装置按照控制器的指示控制减速停止后再转向 移动;
移动装置根据指示控制命令转向后,在控制器的指示控制下保持直行直至指示块检 测单元检测到的工位节点指示块的累积计数等于目标数据组中工位节点指示数据位上 的数据,此时,所述指示块检测单元将自最后一个工位节点指示块上获取的前进方向、 减速距离指示信息传送给控制器;
所述指示块检测单元根据检测到的最后一个工位节点指示块的设置位置获取其转 向指示信息并将该转向信息传送给所述控制器,从而控制器根据获取的前进方向、减速 距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器的指示控制减 速停止后再转向移动;或者所述控制器读取工位节点方向指示数据位中存储的转向参数 从而获取转向指示信息,并根据获取的前进方向、减速距离、转向指示信息向移动装置 发送指示控制命令,移动装置按照控制器的指示控制减速停止后再转向目标工位位置;
所述控制器控制移动装置向目标工位位置直行直至所述指示块检测单元检测到目 标工位停止指示块,所述指示块检测单元将自目标工位停止指示块上获取的减速距离和 停止指示信息传送给控制器,控制器根据指示信息向移动装置发送指示控制命令,从而 使得移动装置减速并最终停止在目标工位上;
步骤五、移动装置在目标工位完成工作后返回起点,在返回过程中,所述指示块检 测单元检测循迹路径中自目标工位至起点的返回路径上的支道指示块,从而获取返回路 径上每个支道指示块上的前进方向、减速距离指示信息并传送给控制器;
所述指示块检测单元根据检测到的每个支道指示块的设置位置,以获取每个支道指 示块位置的转向指示信息并将该转向信息传送给所述控制器,从而控制器根据获取的前 进方向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器 的指示控制在每个支道指示块位置减速停止后再转向移动;或者所述控制器读取返回数 据组中存储的各个支道指示块对应的转向参数从而获取转向指示信息,并根据获取的前 进方向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器 的指示控制减速停止后再转向移动;
所述控制器指示控制移动装置最终转入循迹路径中返回路径的主干道上,并顺利返 回到起点;
步骤六、所述指示块检测单元检测到起点停止指示块后,将自起点停止指示块上获 取的减速距离和停止指示信息传送给控制器,控制器根据指示信息向移动装置发送指示 控制命令,从而使得移动装置减速并最终停止在起点位置;
步骤七、清除所述控制器中的计数及当次的循迹路径编码,并等待进入步骤三。
优选地,所述步骤二中,根据循迹路径及各指示块的设置情况,统计自起点到达各 目标位置的循迹路径中最优路径需要经过的主干道指示块的数量、支道指示块数量、工 位节点指示块数量,同时确定需要的各指示块位置对应的转向参数,从而将相应的数据 分别填入各目标工位的目标数据组的各个数据位中,进而形成各目标工位的循迹路径编 码。
与现有技术相比,本发明的优点在于:
(1)该自动循迹识别指示系统的结构简单,容易标准化大规模生产。通用的智能循 迹移动装置,依靠具有该自动循迹识别指示系统中的指示块单元和指示编码单元的循迹 路径,在无需调整程序的情况下即能准确到达目标工位,且工作过程中数据处理过程简 单。该自动循迹识别指示系统适用面广,通用性强,制造成本低,易于推广使用,能够 有效提高工作效率。
(2)该自动循迹识别指示系统采用指示块单元,对每个路口、目标工位点、起点进 行标记指向。同时指示编码单元能够对各个目标工位进行循迹路径编码,从而实现对循 迹路径的详细规划指示。则通过指示块单元能够实现对各种复杂路径的场所中各目标工 位的指向,从而为快速准确引导移动装置到达目标工位并能顺利返回起始原点提供有有 力的基础。
(3)该自动循迹识别指示系统的指示方法能够指示移动装置快速准确到达任一指 定目的地,操作非常简单,只要初始化当次目标工位的循迹路径编码,启动移动装置后, 移动装置就自主快速准确的到达目标工位。另外,循迹路径编码中本身已经优化了移动 装置的循迹路径,即该自动循迹识别指示系统的指示方法能够优化指导移动装置到达目 标工位。
(4)该自动循迹识别指示系统的指示方法能适用于各种不同的循迹方式,能够给出 多种复杂路径的循迹指示,可用于大型超市货品无人运输、大型工厂物料无人运输、物 流公司物件分拣无人运输、恶劣环境下的货物无人运输等场合,应用广泛,具有良好的 经济效益和社会效益。
附图说明
图1为本发明实施例中自动循迹识别指示系统的结构框图。
图2为本发明实施例中自动循迹识别指示系统的指示方法的流程图。
图3为本发明实施例一中循迹路径和循迹路径编码的示意图。
图4为本发明实施例二中循迹路径和循迹路径编码的示意图。
具体实施方式
以下结合附图实施例对本发明作进一步详细描述。
实施例一
如图1所示,本实施例中的自动循迹识别指示系统,包括指示块单元1、指示块检 测单元2、指示编码单元3和控制器4。
其中指示块单元1包括不同种类的指示块,本实施例中,指示块单元1包括主干道 指示块11、支道指示块12、工位节点指示块13、目标工位停止指示块14和起点停止指 示块15。各种不同种类的指示块分别设置成不同形状的、能够被指示块检测单元2检测 并区分的反光色块。
指示块检测单元2设置于移动装置上,能够检测不同种类的指示块且能从中获取相 应的前进方向、减速距离和/或转向指示信息。本实施例中的指示块检测单元2包括编码 器、解码器及安装分别左右在移动装置底部的两组红外线传感器集阵,两组红外线传感 器集阵分别位于移动装置底板中心线两侧,而每组红外线传感器集阵中包含有一字排列 的八个红外线传感器。在使用时编码器对每个红外传感器进行调制,解码器对接收的红 外光进行解码,从而防止红外线传感器集阵中各红外线传感器相互干扰。
在移动装置前进的过程中,红外线传感器集阵感应色块反射光线进行检测,而反光 色块和地面对发射光线反光强度不同,照射在反光色块上的光线较之照射在地面上的光 线反光强度更高,地面将照射在其上的大部分红外光线吸收,使得相应的红外传感器处 于截止状态,而照射在反光色块上的光线反射会红外传感器,从而相应的红外传感器处 于导通状态。如此可以根据红外传感器集阵中导通状态的红外线传感器个数和截止状态 的红外线传感器的个数,确定循迹路径中反光色块的宽度、长度和形状,从而判断该反 光色块为哪种指示块,同时还可以获取指示块内的指示信息。
本实施例的主干道指示块11分别设置在循迹路径主干道路口且位于主干道中心线 左侧的地面上或者右侧的地面上,以供指示块检测单元2检测从而获取相对应的向左转 向或者向右转向的转向指示信息,即当主干道指示块11设置在循迹路径主干道路口的 左侧位置时,指示块检测单元2中左侧的红外线传感器集阵检测出该主干道指示块11 即获取左转向指示信息,并将该左转向指示信息传送给控制器4,控制器4即控制移动 装置进行左转。当主干道指示块11设置在循迹路径主干道路口的右侧位置时,指示块 检测单元2中右侧的红外线传感器集阵检测出该主干道指示块11即获取后转向指示信 息,并将该右转向指示信息传送给控制器4,控制器4即控制移动装置进行右转,则主 干道指示块11的设置位置能够为移动装置提供转向指示信息。本实施例中的支道指示 块12分别设置在循迹路径支道路口且位于支道中心线左侧的地面上或者右侧的地面上, 以供指示块检测单元2检测从而获取相对应的向左转向或者向右转向的转向指示信息, 其应用原理与主干道指示块11相同。
本实施例中的主干道指示块11设置为直角三角形的反光色块,该作为主干道指示 块11的直角三角形反光色块的一直角边基本平行于主干道的中心线且该直角边最前端 与其指示的转入的支道中心线相对齐,其前端的锐角指向循迹路径的前进方向。而平行 于主干道中心线的直角边的长度为移动装置提供减速距离信息,即自指示块检测单元2 检测到该直角三角形反光色块的底边开始至检测不到为止,控制器4控制移动装置进行 减速并恰好在该直角三角形的反光色块的最前端停止,即控制移动装置停止在与该直角 三角形反光色块指示转入的支道中心线相对齐的位置。本实施例中作为主干道指示块11 的直角三角形反光色块的底边宽度为指示块检测单元2中红外线传感器集阵的七个红外 线传感器的宽度,即指示块检测单元2检测到主干道指示块11时,一侧红外线传感器 集阵中的七个光电管覆盖主干道指示块11的底边,随着移动装置的前进,从七个红外 线传感器的光电管覆盖检测出指示块逐渐减少到检测不到指示块,从而获取主干道指示 块11中的减速距离信息为七级减速指示信息。
本实施例中的支道指示块12同样设置为直角三角形的反光色块,仅直角三角形的 各边长度与主干道指示块11不同,从而提供区别于主干道指示块11的指示块类别及不 同的减速距离信息。该作为支道指示块12的直角三角形反光色块的一直角边基本平行 于支道的中心线且最前端与其指示转入的支道或者主干道的中心线相对齐,其前端的锐 角指向循迹路径的前进方向。该作为支道指示块12的直角三角形反光色块对移动装置 的指示用法相同。本实施例中作为支道左转指示块121的直角三角形放光色块的底边宽 度为指示块检测单元2中红外线传感器集阵的五个红外线传感器的宽度,即指示块检测 单元2检测到支道指示块12时,一侧红外线传感器集阵中的五个光电管覆盖支道指示 块12的底边,随着移动装置的前进,从五个红外线传感器的光电管覆盖检测出指示块 逐渐减少到检测不到指示块,从而获取支道指示块12中的减速距离信息为五级减速指 示信息。
本实施例中的工位节点指示块13分别设置在循迹路径上距离目标工位最近的路口 的地面上且设置在循迹路径中心线上,即每个转向目标工位的路口均设置有工位节点指 示块13。本实施例中的工位节点指示块13设置为等腰三角形反光色块,该等腰三角形 反光色块的顶点指向循迹路径的前进方向且该顶点与待转入目标工位的循迹路径的中 心线相对齐。该作为工位节点指示块13的等腰三角形的反光色块的高表示工位节点指 示块13的减速距离,即自指示块检测单元2检测到该等腰三角形反光色块的底边开始 至检测不到为止,控制器4控制移动装置进行减速并恰好在该等腰三角形反光色块的顶 点位置停止,即控制移动装置停止在与待转入目标工位的循迹路径的中心线相对齐的位 置。本实施例中工位节点指示块13的底边宽度为指示块检测单元2中红外线传感器集 阵的十个红外线传感器的宽度,即指示块检测单元2检测到工位节点指示块13时,两 侧的红外线传感器集阵中的各有五个光电管覆盖工位节点指示块13的底边,随着移动 装置的前进,从五个红外线传感器的光电管覆盖检测出指示块逐渐减少到检测不到指示 块,从而获取工位节点指示块13中的减速距离信息为五级减速指示信息。
本实施例中的目标工位停止指示块14设置在目标工位位置的地面上,该目标工位 停止指示块14同样设置为等腰三角形反光色块,仅等腰三角形反光色块的各边长与工 位节点指示块13不同,从而提供区别于工位节点指示块13的指示块类别及不同的减速 距离信息。该作为目标工位停止指示块14的等腰三角形反光色块的顶点指向循迹路径 的前进方向,且其顶点恰好能够指示移动装置停止在目标工位的工作位置。本实施例中 作为工位停止指示块14的等腰三角形反光色块的底边宽度为指示块检测单元2中红外 线传感器集阵的六个红外线传感器的宽度,即指示块检测单元2检测到工位停止指示块 14时,两侧的红外线传感器集阵中的各有三个光电管覆盖工位停止指示块14的底边, 随着移动装置的前进,从三个红外线传感器的光电管覆盖检测出指示块逐渐减少到检测 不到指示块,从而获取工位停止指示块14中的减速距离信息为三级减速指示信息。
本实施例中的起点停止指示块15设置在循迹路径的返回路径上,并设置于起点位 置的地面上。本实施例中起点停止指示块15同样设置为等腰三角形反光色块,其边长 与作为工位节点指示块13和作为目标工位停止指示块14的等腰三角形反光色块的边长 均不同,从而提供区别于工位节点指示块13和目标工位停止指示块14的指示块类别及 不同的减速距离信息。该作为起点停止指示块15的等腰三角形反光色块的顶点指向循 迹路径的前进方向,且该顶点恰好能够指示移动装置停止在起点位置。本实施例中作为 起点停止指示块15的等腰三角形反光色块的底边宽度为指示块检测单元2中红外线传 感器集阵的十四个红外线传感器的宽度,即指示块检测单元2检测到起点停止指示块15 时,两侧的红外线传感器集阵中的各有七个光电管覆盖起点停止指示块15的底边,随 着移动装置的前进,从七个红外线传感器的光电管覆盖检测出指示块逐渐减少到检测不 到指示块,从而获取起点停止指示块15中的减速距离信息为七级减速指示信息。
在移动装置移动的过程中,如果设置在移动装置底板中心线左侧的红外线传感器集 阵检测到主干道中心线或者支道中心线左侧存在反光色块后,使得左侧的红外线传感器 集阵中的各红外线传感器按照一定的规律处于导通和截止状态,同时获取反光色块的宽 度和形状信息,进而与相应指示块的宽度和形状进行匹配,从而判断该指示块的种类, 同时获取指示块上的指示信息。而设置在移动装置底板中心线右侧的红外线传感器集阵 中的各红外线传感器则全部处于截止状态,如此即获取该指示块上的左转向信息。指示 块检测单元2将其检测获取到的指示信息传送给控制器4后,控制器4即按照控制信息 向移动装置发送相应的减速停止并左转的指示控制命令,从而使得移动装置按照指示信 息减速停止后再向左转向移动。
同理,在移动装置移动的过程中,如果设置在移动装置底板中心线右侧的红外线传 感器集阵检测到主干道中心线或者支道中心线右侧存在反光色块后,使得右侧的红外线 传感器集阵中的各红外线传感器按照一定的规律处于导通和截止状态,同时获取反光色 块的宽度和形状信息,进而与相应指示块的宽度和形状进行匹配,从而判断该指示块的 种类,同时获取指示块上的指示信息。而设置在移动装置底板中心线左侧的红外线传感 器集阵中的各红外线传感器则全部处于截止状态,如此即获取该指示块上的右转向信 息。指示块检测单元2将其检测获取到的指示信息传送给控制器4后,控制器4即按照 控制信息向移动装置发送相应的减速停止并右转的指示控制命令,从而使得移动装置按 照指示信息减速停止后再向右转向移动。
指示编码单元3中存储有各个目标工位的循迹路径编码,每个循迹路径编码中包含 有自起点到达该目标工位的循迹路径中、需要检测到的各种指示块的总数及需要的指示 块的转向参数。即针对一个设定好的循迹路径图纸,针对每个目标工位进行人工编码从 而形成循迹路径编码并存储在指示编码单元3中。
为了能够方便准确的指示出目标工位,方便控制器进行计算,指示编码单元3中每 个目标工位的循迹路径编码包括至少一组用于指示自起点到达该目标工位的目标数据 组,根据循迹路径的不同复杂程度,该自动循迹识别指示系统还可以设置除本实施例外 的多种其他指示块,也可以设置多种类型指示移动装置移动的数据组。
本实施例中的目标数据组包括四个数据位,该四个数据为分别为存储有自起点到达 目标工位的循迹路径中需要经过的主干道指示块11总量的主干道指示数据位、存储有 自起点到达目标工位的循迹路径中需要经过的支道指示块12总量的支道指示数据位、 存储有自起点到达目标工位的循迹路径中需要经过的工位节点指示块13总量的工位节 点指示数据位、存储有自起点到达目标工位前最后一个工位节点位置至目标工位位置的 转向参数的工位节点方向指示数据位。其中主干道指示数据位放置在第一位,支道指示 数据位放置在第二位,工位节点指示数据位放置在第三位,工位节点方向指示数据位放 置在第四位。本实施例中定义数据“6”为左转向参数,定义数据“8”为右转向参数。
其中在循迹路径中的第一个支道指示块12位置不需要转弯的情况下,将支道指示 块数据位置存入数据“0”。
根据循迹路径不同的复杂程度,该目标数据组中的数据位个数也可以根据指示块的 增减而增减,具体以能够准确指示移动装置循迹为准。
控制器4分别与指示块检测单元2、指示编码单元3、移动装置进行通讯连接,用 于处理指示块检测单元2和指示编码单元3的信息并向移动装置发送指示控制命令。根 据不同的设计,该控制器4可以设置在移动装置中央控制器中,也可以单独外置设置, 以能够处理指示块检测单元2和指示编码单元3中的信息,以能够控制移动装置移动为 准。
上述的自动循迹识别指示系统成本低、实用性强,特别适用于超市大型超市货架、 大型工厂工作区等复杂场所使用。
前述的自动循迹识别指示系统还可以配合循迹系统使用,在循迹系统的循迹路径和 循迹方法的基础上,为循迹系统提供指示信息,从而提高循迹速度及循迹的精程度。
为了更加清楚的描述本实施例中自动循迹识别指示系统的指示方法,结合图3所示 的循迹路径,对循迹路径编码为“6338”的目标工位的指示方法进行详细的描述,图3 所示的循迹路径中主干道包围于支道的四周设置,但是本实施例中自动循迹识别指示系 统的指示方法不限于该种循迹路径。
如图2所示,本实施例中自动循迹识别指示系统的指示方法包括如下步骤:
步骤一、根据循迹路径的规划及各指示块能够提供的指示信息,在主干道的各路口、 支道各路口、工位节点、目标工位、起点这些位置分别放置相应的指示块。
即在循迹路径主干道需要左转的路口,将主干道指示块11设置在该路口且位于主 干道中心线左侧的地面上,并且主干道指示块11指向前进方向,在循迹路径主干道需 要右转的路口,将主干道指示块11设置该路口且位于主干道中心线右侧位置,并且主 干道指示块11指向前进方向。
在循迹路径支道需要左转的路口,将支道指示块12设置在该路口且位于支道中心 线左侧的地面上,并且支道指示块12指向前进方向,在循迹路径支道需要右转的路口, 将支道指示块12设置该路口且位于支道中心线右侧位置,并且支道指示块12指向前进 方向。
将工位节点指示块13分别设置在循迹路径上各个距离目标工位最近的路口地面上, 并且工位节点指示块13指向前进方向,将目标工位停止指示块14设置在各目标工位位 置的地面上,将起点停止指示块15设置在起点位置的地面上。
步骤二、根据循迹路径及各指示块的设置情况,对指示编码单元3进行编码,从而 形成各目标工位的循迹路径编码。
即根据循迹路径及各指示块的设置情况,统计自起点到达各目标位置最优的循迹路 径中需要经过的主干道指示块11数量、支道指示块12数量、工位节点指示块13数量, 同时确定距离目标工位最近的工位节点指示块13位置转向目标工位的转向参数,进而 将相应的数据填入到各目标工位对应的目标数据组中的各个数据位,从而形成各目标工 位的循迹路径编码。
如本实施例中循迹路径编码为“6338”的目标工位,代表在移动装置的行进过程中, 需要检测到的主干道指示块11的数量为六,需要检测到的支道指示块12的数量为三, 需要检测的工位节点指示块13的数量为三,目标工位的转向参数为“8”,即在最后一 个工位节点指示块13处需要右转,如此即形成该目标工位完整的循迹路径编码“6338”。
步骤三、在控制器4中初始化当次目标工位的循迹路径编码,本实施例中即将目标 工位的循迹路径编码“6338”输入到控制器4以便控制器4在工作过程中进行计算。
步骤四、启动移动装置,根据不同的设计需要,本实施例中移动装置可以根据指示 块的指示移动到主干道上的出发位置,或者通过控制器4内预设的控制指令移动到主干 道的出发位置,然后再向前直行。
在移动装置在向目标工位行进的循迹路径中,利用指示块检测单元2检测循迹路径 中各路口设置的指示块,并将检测到的指示块内包含的指示信息传送到控制器4中,控 制器4接收指示块检测单元2传送的指示信息并对各种指示块的数量进行累积计数,同 时控制器4将各种指示块的累积数据与目标数据组中的数据进行比对。
本实施例中,控制器4向移动装置发送直行的指示控制命令直至对主干道指示块11 数量的累积计数等于目标数据组中主干道指示数据位上的数据“6”。即在按照循迹路径 行进过程中,指示块检测单元2每检测到主干道指示块11的底边后即能判断出该指示 块的种类,控制器4立即获取指示块检测单元2传送的指示块种类信息,同时对主干道 指示块11进行累积计数,然后再和主干道指示数据位上的数据进行比较。当数据不等 时,则控制器4指示控制移动装置直行,而不会受指示块检测单元2传送的主干道指示 块11信息影响。而当指示块检测单元2检测到第六个主干道指示块11底边的信号后, 则控制器4对主干道指示块11的累积计数达到六,此时指示块检测单元2将自第六个 主干道指示块11上获取的前进方向、减速距离指示信息传送给控制器4。
同时指示块检测单元2中设置在移动装置底部左侧的红外线传感器集阵检测到的第 六个主干道指示块11,即第六个主干道指示块11设置在主干道中心线左侧位置,从而 指示块检测单元2从第六个主干道指示块11获取左转向指示信息并传送给控制器4。控 制器4根据获取的前进方向、减速距离、左转向指示信息向移动装置发送指示控制命令, 移动装置按照控制器4的指示控制进行七级减速并停止,待指示块检测单元2对作为第 六个主干道指示块11的反光色块的最前端检测完毕时,控制器4恰好控制移动装置停 止。然后移动装置在控制器4的控制再向左转向进入循迹路径的支道中。
当目标数据组中支道指示数据位上的数据为“0”时,则控制器4向移动装置发送 直行的指示控制命令直至工位节点指示块13的累积计数等于目标数据组中工位节点指 示数据位上的数据,同时指示块检测单元2将自最后一个工位节点指示块13上获取的 前进方向、减速距离指示信息传送给控制器4。控制器4读取工位节点方向指示数据位 中存储的转向参数从而获取转向指示信息,并根据获取的前进方向、减速距离、转向指 示信息向移动装置发送指示控制命令,移动装置按照控制器4的指示控制减速停止后再 转向目标工位位置。控制器4控制移动装置向目标工位位置直行直至所述指示块检测单 元2检测到目标工位停止指示块14,指示块检测单元2将自目标工位停止指示块14上 获取的减速距离和停止指示信息传送给控制器4,控制器4根据指示信息向移动装置发 送指示控制命令,从而使得移动装置减速并最终停止在目标工位上。这种情况具体可参 见图3中循迹路径编码为“6038”的情况。
当目标数据组中支道指示数据位上的数据不为“0”时,则控制器4向移动装置发 送直行的指示控制命令直至指示块检测单元2检测到第一个支道指示块12,指示块检测 单元2将自第一个支道指示块12上获取的前进方向、减速距离指示信息传送给控制器4, 同时控制器4对支道指示块12的累积计数加一后变为一。
本实施例中,指示块检测单元2中设置在移动装置底部左侧的红外线传感器集阵检 测到的第一个支道指示块12,即第一个支道指示块12设置在支道中心线左侧位置,从 而指示块检测单元2从第一个支道指示块12获取左转向指示信息并传送给控制器4。控 制器4根据获取的前进方向、减速距离、转向指示信息向移动装置发送指示控制命令, 移动装置按照控制器4的指示控制进行五级减速停止后再向左转向移动。
移动装置根据指示控制命令左转后,在控制器4的指示控制下保持直行直至指示块 检测单元2检测到的支道指示块12的累积计数等于目标数据组中支道指示数据位上的 数据“3”。即在移动装置行进的过程中,指示块检测单元2又依次检测到第二个支道指 示块12,此时控制器4对支道指示块12的累计计数加一,即对支道指示块12的累计计 数达到二,与第二数据位上的数据“3”进行比较,小于支道指示数据位上的数据“3”, 则控制器4指示控制移动装置继续直行。当指示块检测单元2检测到第三个支道指示块 12时,控制器4对支道指示块12的累计计数加一后达到三,与支道指示数据位上的数 据“3”进行比较,两个数值相等。此时指示块检测单元2将自第三个支道指示块12上 获取的前进方向、减速距离指示信息传送给控制器4。
指示块检测单元2中设置在移动装置底部右侧的红外线传感器集阵检测到的第三个 支道指示块12,即第三个支道指示块12设置在支道中心线右侧位置,从而指示块检测 单元2从第三个支道指示块12获取右转向指示信息并传送给控制器4。控制器4根据获 取的前进方向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照 控制器4的指示控制进行五级减速停止后再向右转向移动。
移动装置根据指示控制命令转向后,在控制器4的指示控制下保持直行直至指示块 检测单元2检测到的工位节点指示块13的累积计数等于目标数据组中工位节点指示数 据位上的数据“3”。指示块检测单元2将自第三个工位节点指示块13上获取的前进方 向、减速距离指示信息传送给控制器4。
控制器4读取工位节点方向指示数据位中存储的转向参数“8”,从而获取在第三个 工位节点指示块13位置的右转向指示信息,并根据获取的前进方向、减速距离、转向 指示信息向移动装置发送指示控制命令,移动装置按照控制器4的指示控制进行三级减 速停止后再向右转向目标工位位置。
控制器4控制移动装置向目标工位位置直行直至指示块检测单元2检测到目标工位 停止指示块14,指示块检测单元2将自目标工位停止指示块14上获取的减速距离和停 止指示信息传送给控制器4,控制器4根据指示信息向移动装置发送指示控制命令,从 而使得移动装置进行三级减速并最终停止在目标工位上。
步骤五、移动装置在目标工位完成工作后返回起点,在返回过程中,指示块检测单 元2检测循迹路径中自目标工位至起点的返回路径上的各个支道指示块12,从而获取返 回路径上每个支道指示块12上的前进方向、减速距离指示信息并传送给控制器4。
指示块检测单元2根据检测到的每个支道指示块12的设置位置,获取在每个支道 指示块12位置的转向指示信息并将该转向信息传送给所述控制器4,从而控制器4在每 个支道指示块12位置根据获取的前进方向、减速距离、转向指示信息向移动装置发送 指示控制命令,移动装置按照控制器4的指示控制在每个支道指示块12位置进行五级 减速后停止,然后再转向移动,最终转入循迹路径中返回路径的主干道上,移动装置再 根据控制器4内预设的返回控制命令顺利返回到起点。
本实施例中,移动装置返回过程中,指示块检测单元2检测到的第一个支道指示块 12上的前进信息和五级减速距离信息,同时由于指示块检测单元2中右侧的红外线传感 器集阵检测到该第一个支道指示块12,即该第一个支道指示块12设置在支道中心线右 侧的地面上,从而指示块检测单元2获取该第一个支道指示块12位置的方向指示信息 为右转向指示信息,则控制器4控制移动装置进行五级减速停止后,再进行右转进入下 一条支道中。
移动装置右转后,控制器4控制移动装置继续直行。指示块检测单元2随之检测到 第二个支指示块12,同时由于指示块检测单元2中左侧的红外线传感器集阵检测到该第 二个支道指示块12,从而指示块检测单元2获取该第二个支道指示块12位置的方向指 示信息为左转向指示信息,则控制器4控制移动装置进行五级减速停止后,再进行左转。 移动装置左转后即进入到循迹路径中返回路径的主干道上,随之移动装置顺利返回到起 点。移动装置根据不同的设计要求,可以在指示块的指示下自返回路径的主干道返回起 点,也可以根据控制器4内预设的控制指令自返回路径的主干道返回起点。
步骤六、指示块检测单元2检测到起点停止指示块15后,将自起点停止指示块15 上获取的七级减速距离指示信息和停止指示信息传送给控制器4,控制器4根据指示信 息向移动装置发送指示控制命令,从而使得移动装置进行七级减速后,最终停止在起点 位置,如此便完成一次完整的循迹指示。
步骤七、清除控制器4中的计数及当次的循迹路径编码,并等待进入步骤三。
实施例二
本实施与实施例一的区别为:本实施例中的主干道指示块11设置在主干道的各个 路口,并设置在主干道中心线上。主干道指示块11设置为等腰三角形反光色块,该等 腰三角形反光色块的顶点指向循迹路径的前进方向且该顶点与待转入的支道中心线相 对齐。该作为主干道指示块11的等腰三角形的反光色块的高表示主干道指示块11的减 速距离,即自指示块检测单元2检测到该等腰三角形反光色块的底边开始至检测不到为 止,控制器4控制移动装置进行减速并恰好在该等腰三角形反光色块的顶点位置停止, 即控制移动装置停止在与待转入支道中心线相对齐的位置。本实施例中主干道指示块11 的底边宽度为指示块检测单元2中红外线传感器集阵的十二个红外线传感器的宽度,即 指示块检测单元2检测到主干道指示块11时,两侧的红外线传感器集阵中的各有六个 光电管覆盖主干道指示块11的底边,随着移动装置的前进,从六个红外线传感器的光 电管覆盖检测出指示块逐渐减少到检测不到指示块,从而获取主干道指示块11中的减 速距离信息为六级减速指示信息。
目标数据组中还包括有主干道方向指示数据位,该主干道方向指示数据位中存储有 自起点到达目标工位的循迹路径中、最后一个主干道指示块11位置的转向参数。
则相应的自动循迹识别指示系统的指示方法则有所区别。本实施例结合图4中所示 的循迹路径,对循迹路径编码为“26016”的目标工位的指示方法进行对比说明。图4 所示的循迹路径中用于自目标工位返回到起点经过的返回主干道包围于支道的四周,用 于自起点到达目标工位的出发主干道自支道中穿过。
如图2所示,本实施例中自动循迹识别指示系统的指示方法包括如下步骤:
步骤一、根据循迹路径的规划及各指示块能够提供的指示信息,在主干道的各路口、 支道各路口、工位节点、目标工位、起点这些位置分别相应的放置主干道指示块11、支 道指示块12、工位节点指示块13、目标工位停止指示块14。
步骤二、根据循迹路径及各指示块的设置情况,对指示编码单元3进行编码,从而 形成各目标工位的循迹路径编码,分别正对各个目标工位,在其对应目标数据组中的主 干道指示数据位、主干道方向指示数据位、支道指示数据位、工位节点指示数据位、工 位节点方向指示数据位中分别填出相应的数据。本实施例中的主干道指示数据位、主干 道方向指示数据位、支道指示数据位、工位节点指示数据位、工位节点方向指示数据位 按照顺序依次排列。
步骤三、在控制器4中初始化当次目标工位的循迹路径编码,本实施例中即将目标 工位的循迹路径编码“26016”输入到控制器4,以便控制器4在工作过程中进行计算。
步骤四、启动移动装置,控制器4控制移动装置进行直行,同时指示块检测单元2 检测循迹路径中各路口设置的指示块,指示块检测单元2首先检测主干道上的主干道指 示块11并与控制器4之间进行通讯,控制器4对指示块检测单元2检测的主干道指示 块11数量进行累积计数,同时与主干道指示数据位中的数据进行比对。当控制器4对 主干道指示块11数量的计数达到主干道指示数据位中的数据“2”时,指示块检测单元 2将自第二个主干道指示块11上获取的前进方向、减速距离指示信息传送给控制器4。 同时控制器4读取主干道方向指示数据位中存储的转向参数,主干道方向指示数据位中 数据为“6”为控制器4提供了左转向指示信息。控制器4根据获取的前进方向、减速 距离、左转向指示信息向移动装置发送指示控制命令,移动装置按照控制器4的指示控 制进行六级减速并停止,然后左转进入循迹路径的支道中。
控制器4读取支道指示数据位上的数据为“0”,则控制器4向移动装置发送直行的 指示控制命令直至工位节点指示块13的累积计数等于目标数据组中工位节点指示数据 位上的数据“1”,即指示块检测单元2将检测到的第一个工位节点指示块13上获取的 前进方向、减速距离指示信息传送给控制器4。同时,控制器4读取工位节点方向指示 数据位中存储的转向参数“6”,从而获取左转向指示信息,进而控制器4根据获取的前 进方向、减速距离、转向指示信息向移动装置发送指示控制命令,移动装置按照控制器 4的指示控制进行五级减速停止后,再向左转向移动至目标工位位置。
控制器4控制移动装置向目标工位位置直行直至指示块检测单元2检测到目标工位 停止指示块14,指示块检测单元2将自目标工位停止指示块14上获取的减速距离和停 止指示信息传送给控制器4,控制器4根据指示信息向移动装置发送指示控制命令,从 而使得移动装置进行三级减速并最终停止在目标工位上。
步骤五、移动装置在目标工位完成工作后返回起点,在返回过程中,指示块检测单 元2检测循迹路径中自目标工位至起点的返回路径上的各个支道指示块12,从而获取返 回路径上每个支道指示块12上的前进方向、减速距离指示信息并传送给控制器4。
指示块检测单元2根据检测到的每个支道指示块12的设置位置,获取在每个支道 指示块12位置的转向指示信息并将该转向信息传送给所述控制器4,从而控制器4在每 个支道指示块12位置根据获取的前进方向、减速距离、转向指示信息向移动装置发送 指示控制命令,移动装置按照控制器4的指示控制在每个支道指示块12位置进行五级 减速后停止,然后再转向移动,最终转入循迹路径中返回路径的主干道上,从而顺利返 回到起点。移动装置根据不同的设计要求,可以在指示块的指示下自返回路径的主干道 返回起点,也可以根据控制器4内预设的控制指令自返回路径的主干道返回起点。
步骤六、指示块检测单元2检测到起点停止指示块15后,将自起点停止指示块15 上获取的七级减速距离指示信息和停止指示信息传送给控制器4,控制器4根据指示信 息向移动装置发送指示控制命令,从而使得移动装置进行七级减速后,最终停止在起点 位置,如此便完成一次完整的循迹指示。
步骤七、清除控制器4中的计数及当次的循迹路径编码,并等待进入步骤三。

一种自动循迹识别指示系统及其指示方法.pdf_第1页
第1页 / 共23页
一种自动循迹识别指示系统及其指示方法.pdf_第2页
第2页 / 共23页
一种自动循迹识别指示系统及其指示方法.pdf_第3页
第3页 / 共23页
点击查看更多>>
资源描述

《一种自动循迹识别指示系统及其指示方法.pdf》由会员分享,可在线阅读,更多相关《一种自动循迹识别指示系统及其指示方法.pdf(23页珍藏版)》请在专利查询网上搜索。

本发明涉及一种自动循迹识别指示系统,包括用于为移动装置提供指示信息的指示块单元,用于检测指示块单元上指示信息的指示块检测单元,为移动装置提供路径指示的控制器。该自动循迹识别指示系统结构简单、识别处理速度快。本发明还涉及一种自动循迹识别指示系统的指示方法,该指示方法能够自各种复杂程度的循迹路径中指示移动装置快速准确到达任一指定目的工位位置。。

展开阅读全文
相关资源
猜你喜欢
相关搜索

当前位置:首页 > 物理 > 控制;调节


copyright@ 2017-2020 zhuanlichaxun.net网站版权所有
经营许可证编号:粤ICP备2021068784号-1