CN206075136U - 基于模糊算法的视觉导航控制*** - Google Patents
基于模糊算法的视觉导航控制*** Download PDFInfo
- Publication number
- CN206075136U CN206075136U CN201620976521.5U CN201620976521U CN206075136U CN 206075136 U CN206075136 U CN 206075136U CN 201620976521 U CN201620976521 U CN 201620976521U CN 206075136 U CN206075136 U CN 206075136U
- Authority
- CN
- China
- Prior art keywords
- navigation
- agv
- control system
- algorithmic approach
- vision
- 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.)
- Expired - Fee Related
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本实用新型涉及导航技术领域,尤其涉及一种基于模糊算法的视觉导航控制***,该基于模糊算法的视觉导航控制***用于控制AGV的行驶,基于模糊算法的视觉导航控制***包括PLC控制器、CCD摄像机、自动导航单元、手持式操作单元、操作单元接收器和手持式操作面板,自动导航单元包括导航色带和二维码带,AGV通过导航色带进行导航行驶,二维码带设置在需要AGV改变速度、方向或精确定位的位置,操作单元接收器与PLC控制器相连接。本实用新型可以控制AGV精确定位取货,并进行高速自动导航行驶。
Description
技术领域
本实用新型涉及导航技术领域,尤其涉及基于模糊算法的视觉导航控制***。
背景技术
近年来,自动导航车(Automated Guide Vehicle,AGV)被广泛地应用到了物流、烟草、食品行业、汽车制造等各个行业中。现阶段AGV的研究热点集中于改进导航方式及控制方法。目前,AGV的导航方式主要有磁带导航、激光导航、惯性导航等。随着机器视觉技术及计算机技术的不断发展,基于视觉的AGV导航技术逐渐成为主要的研究方向。
AGV的视觉导航方式是正在快速发展和成熟的一种新型导航方式。AGV在行驶过程中,通过CCD摄像机和传感器动态获取车辆的行驶轨迹信息,并与数据库进行比较,从而确定当前位置信息并对下一步行驶做出决策。
模糊逻辑控制(Fuzzy Logic Control)简称模糊控制(Fuzzy Control),是以模糊集合论、模糊语言变量和模糊逻辑推理为基础的一种计算机数字控制技术。1965年,美国的L.A.Zadeh创立了模糊集合论;1973年他给出了模糊逻辑控制的定义和相关的定理。1974年,英国的E.H.Mamdani首次根据模糊控制语句组成模糊控制器,并将它应用于锅炉和蒸汽机的控制,获得了实验室的成功。这一开拓性的工作标志着模糊控制论的诞生。近20多年来,模糊控制不论在理论上还是技术上都有了长足的进步,成为自动控制领域一个非常活跃而又硕果累累的分支。
目前,国内AGV行业主要的导航方式为磁带导航和激光导航。磁带导航优点:磁带导航灵活性比较好,改变或扩充路径较容易,磁带铺设也相对简单,导引原理简单而可靠,对声光无干扰,投资成本比激光导引式低很多。激光导航优点:地面无需定位设施,行驶路径可灵活改变。但AGV在高速度行驶、高精度定位时,以上两种导航方式很难满足技术要求,不具备很好的实时性、精确性和鲁棒性。
实用新型内容
为克服上述现有技术的不足,本实用新型提供一种可以使AGV自动导航行驶的基于模糊算法的视觉导航控制***。
本实用新型公开了基于模糊算法的视觉导航控制***,该基于模糊算法的视觉导航控制***用于控制AGV的行驶,基于模糊算法的视觉导航控制***包括PLC控制器、CCD摄像机、自动导航单元、手持式操作单元、操作单元接收器和手持式操作面板,自动导航单元包括导航色带和二维码带,AGV通过导航色带进行导航行驶,二维码带设置在需要AGV改变速度、方向或精确定位的位置,操作单元接收器与PLC控制器相连接,操作单元接收器用于接收手持式操作单元或手持式操作面板发送的操作AGV的命令,CCD摄像机安装在AGV的上方,CCD摄像机用于识别导航色带和二维码带铺设的路径,CCD摄像机将识别的导航色带和二维码带铺设的路径传输给PLC控制器,PLC控制器使得AGV按照导航色带和二维码带铺设的路径行驶。
作为本实用新型的优化方案,基于模糊算法的视觉导航控制***还包括安全控制单元,安全控制单元用于使AGV行驶时绕过障碍物,安全控制单元为激光扫描仪,激光扫描仪与PLC控制器相连。
作为本实用新型的优化方案,CCD摄像机集成有LED光源,LED光源用于提供CCD摄像机工作时的光源。
本实用新型具有积极的效果:1)本实用新型利用CCD摄像机获取AGV行驶轨迹偏离误差,然后通过模糊算法输出了AGV差速控制偏移量,满足了AGV高速行驶,高精度定位的需求,实时性好,鲁棒性好;
2)本实用新型可以控制AGV精确定位取货,并进行高速自动导航行驶;
3)本实用新型配备了激光扫描仪,避免了AGV行驶过程中可以有效的绕过障碍物,提高了AGV行驶的安全性。
附图说明
为了使本实用新型的内容更容易被清楚地理解,下面根据具体实施例并结合附图,对本实用新型作进一步详细的说明:
图1为AGV行驶轨迹偏离误差E模糊子集的隶属度函数;
图2是AGV视觉导航路径示意图;
图3是基于模糊算法的视觉导航控制***的框图。
其中:1、CCD摄像机,2、PLC控制器,3、自动导航单元,4、手持式操作单元,5、操作单元接收器,6、手持式操作面板,7、安全控制单元。
具体实施方式
本实用新型公开了基于模糊算法的视觉导航控制方法,CCD摄像机1测量AGV行驶轨迹偏离误差,PLC控制器2根据CCD摄像机1测量AGV行驶轨迹偏离误差计算出AGV行驶轨迹偏离误差率,将AGV行驶轨迹偏离误差和AGV行驶轨迹偏离误差率输入基于模糊算法的视觉导航测量模型计算出AGV差速控制偏移量,具体步骤包括:
1)输入输出模糊化处理
将AGV行驶轨迹偏离误差E和AGV行驶轨迹误差变化率EC作为模糊算法的输入变量,AGV差速控制偏移量U作为输出变量,其中,输入变量AGV行驶轨迹偏离误差E和AGV行驶轨迹误差变化率EC的实际范围为变量的基本论域,基本论域内的量为精确量;
AGV行驶轨迹偏离误差E所取的模糊子集的论域为{-6,-5,-4,-3,-2,-1,0,+1,+2,+3,+4,+5,+6};
输入量AGV行驶轨迹偏离误差E的模糊化:
输入量:e;
基本论域:[-|emax|},+|emax}],即:[-30,+30],单位:mm;
量化论域:[-nl,+nl],即:[-6,+6];
模糊词集:NB,NM,NS,0,PS,PM,PB;
误差的量化因子公式:Ke=nl/|emax|;
误差量化因子:Ke=6/30=0.2
AGV行驶轨迹误差变化率EC、AGV差速控制偏移量U和AGV行驶轨迹偏离误差E的模糊化处理相同;
AGV行驶轨迹偏离误差E、AGV行驶轨迹误差变化率EC和AGV差速控制偏移量U的语言值隶属度函数均采用对称三角形隶属度函数,如图1和表1所示;
表1行驶轨迹偏离误差E模糊子集的赋值表
2)建立模糊规则,进行模糊推理
模糊规则的建立,是把操作者的经验加以总结,并将在控制过程中由经验得来的相应措施总结成一条条控制规则,由它们构成一个“模糊控制器”,从而达到用机器代替人对复杂的工业过程进行控制。根据人员对AGV实际轨迹纠偏能力的操作经验,将行驶过程中要遇到的各种可能出现的轨迹偏移情况和相应的控制策略汇总成表,具体的语句例如:
If E=NB and EC=NB then U=NB,如表2所示。
表2控制策略表
建立模糊控制策略表,采用Zadeh推理法则,由模糊控制策略表计算出控制量,即模糊控制量为模糊集合U;经过模糊推理将模糊控制量转换为精确量,模糊推理所获得的结果仍是一个模糊值,不能直接用来作为被控对象的控制量,需要将其转换成一个可以被执行机构所实现的精确量,此过程一般被称为反模糊化过程,反模糊化采用最大隶属度法,将上述结果离线做成查询表,并将查询表的内容存放在PLC控制器2的内存中在实时控制时使用。
由If E=PB and EC=PB or EC=PS or EC=ZO Then U=PB语句所确定的关系可用下列式子表达:
R=[PBe×PBu]·[(PBec+PSec+ZOec)×PBu]
则
U1=e·[PBe×PBu]·ec·[(PBec+PSec+ZOec)×PBu]
把E和EC的隶属度函数值对应于所量化的等级上取1,其余均取零值,这样上式可简化为:
式中:μPBe(i)是模糊集合PBE第i个元素的隶属度,而μPBec(j)、μPSec(j)、μZOec(j)
是模糊集合PBEC、PSEC和ZOEC第j个元素的隶属度;
则AGV差速控制偏移量U为:
U=u1+u2+……+u14
采用隶属度最大原则将模糊控制量转换为精确量即可。
本实用新型还公开了基于模糊算法的视觉导航控制***,该基于模糊算法的视觉导航控制***用于控制AGV的行驶,基于模糊算法的视觉导航控制***包括PLC控制器2、CCD摄像机1、自动导航单元3、手持式操作单元4、操作单元接收器5和手持式操作面板6,自动导航单元3包括导航色带和二维码带,AGV通过导航色带进行导航行驶,二维码带设置在需要AGV改变速度、方向或精确定位的位置,操作单元接收器5与PLC控制器2相连接,操作单元接收器5用于接收手持式操作单元4或手持式操作面板6发送的操作AGV的命令,CCD摄像机1安装在AGV的上方,CCD摄像机1用于识别导航色带和二维码带铺设的路径,CCD摄像机1将识别的导航色带和二维码带铺设的路径传输给PLC控制器2,PLC控制器2使得AGV按照导航色带和二维码带铺设的路径行驶。其中,AGV行驶时,导航主要是采用导航色带,导航色带的颜色要与地面的颜色有强烈的反差。手持式操作单元4可以是带手柄的遥控器,手持式操作面板6可以是平板手机等移动终端,CCD摄像机1用于识别导航色带和二维码带铺设的路径,CCD摄像机1将识别的路径传输给PLC控制器2,PLC控制器2使得AGV按照CCD摄像机1识别的路径行驶。
基于模糊算法的视觉导航控制***还包括安全控制单元7,安全控制单元7用于使AGV行驶时绕过障碍物,安全控制单元7为激光扫描仪,激光扫描仪与PLC控制器2相连。其中,激光扫描仪发出激光脉冲,当激光碰到物体后,部分激光反射回激光扫描仪。激光扫描仪通过计算发射和接收时间的脉冲时间差,可计算出物体距离值。激光扫描仪连续不断的发射激光脉冲,由旋转的机构将激光脉冲按照一定间隔角度(角度分辨率)发射至扫描角度内的各个方向进而形成一个二维扫描平面。
CCD摄像机1集成有LED光源,LED光源用于提供CCD摄像机1工作时的光源。保证外界光线昏暗时,CCD摄像机1可以正常根据导航色带行驶。
以上所述的具体实施例,对本实用新型的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本实用新型的具体实施例而已,并不用于限制本实用新型,凡在本实用新型的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本实用新型的保护范围之内。
Claims (3)
1.基于模糊算法的视觉导航控制***,其特征在于:所述基于模糊算法的视觉导航控制***用于控制AGV的行驶,所述基于模糊算法的视觉导航控制***包括PLC控制器(2)、CCD摄像机(1)、自动导航单元(3)、手持式操作单元(4)、操作单元接收器(5)和手持式操作面板(6),所述的自动导航单元(3)包括导航色带和二维码带,AGV通过导航色带进行导航行驶,二维码带设置在需要AGV改变速度、方向或精确定位的位置,操作单元接收器(5)与PLC控制器(2)相连接,操作单元接收器(5)用于接收手持式操作单元(4)或手持式操作面板(6)发送的操作AGV的命令,所述的CCD摄像机(1)安装在AGV的上方,所述的CCD摄像机(1)用于识别导航色带和二维码带铺设的路径,所述的CCD摄像机(1)将识别的导航色带和二维码带铺设的路径传输给PLC控制器(2),PLC控制器(2)使得AGV按照导航色带和二维码带铺设的路径行驶。
2.根据权利要求1所述的基于模糊算法的视觉导航控制***,其特征在于:所述基于模糊算法的视觉导航控制***还包括安全控制单元(7),所述的安全控制单元(7)用于使AGV行驶时绕过障碍物,所述的安全控制单元(7)为激光扫描仪,所述的激光扫描仪与PLC控制器(2)相连。
3.根据权利要求1所述的基于模糊算法的视觉导航控制***,其特征在于:所述的CCD摄像机(1)集成有LED光源,所述的LED光源用于提供CCD摄像机(1)工作时的光源。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201620976521.5U CN206075136U (zh) | 2016-08-29 | 2016-08-29 | 基于模糊算法的视觉导航控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201620976521.5U CN206075136U (zh) | 2016-08-29 | 2016-08-29 | 基于模糊算法的视觉导航控制*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN206075136U true CN206075136U (zh) | 2017-04-05 |
Family
ID=58433007
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201620976521.5U Expired - Fee Related CN206075136U (zh) | 2016-08-29 | 2016-08-29 | 基于模糊算法的视觉导航控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN206075136U (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108180912A (zh) * | 2017-12-31 | 2018-06-19 | 芜湖哈特机器人产业技术研究院有限公司 | 基于混合导航带的移动机器人定位***及方法 |
CN108196552A (zh) * | 2018-02-11 | 2018-06-22 | 成都兴联宜科技有限公司 | 一种智能小车的gps视觉导航*** |
CN108227701A (zh) * | 2017-12-11 | 2018-06-29 | 大连四达高技术发展有限公司 | 用于自动移动搬运车辆的光学引导定位*** |
CN108459600A (zh) * | 2018-02-11 | 2018-08-28 | 成都兴联宜科技有限公司 | 一种agv小车的视觉导航*** |
CN108804968A (zh) * | 2018-05-28 | 2018-11-13 | 重庆瑞耕达网络科技有限公司 | 一种agv二维码铺设装置 |
WO2019076320A1 (zh) * | 2017-10-17 | 2019-04-25 | 杭州海康机器人技术有限公司 | 机器人定位方法、装置及计算机可读存储介质 |
CN109709958A (zh) * | 2018-12-26 | 2019-05-03 | 南京航空航天大学 | 一种用于agv电磁导航控制***的可拓控制方法 |
CN112987729A (zh) * | 2021-02-09 | 2021-06-18 | 灵动科技(北京)有限公司 | 用于控制自主移动机器人的方法和装置 |
-
2016
- 2016-08-29 CN CN201620976521.5U patent/CN206075136U/zh not_active Expired - Fee Related
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019076320A1 (zh) * | 2017-10-17 | 2019-04-25 | 杭州海康机器人技术有限公司 | 机器人定位方法、装置及计算机可读存储介质 |
CN108227701A (zh) * | 2017-12-11 | 2018-06-29 | 大连四达高技术发展有限公司 | 用于自动移动搬运车辆的光学引导定位*** |
CN108180912A (zh) * | 2017-12-31 | 2018-06-19 | 芜湖哈特机器人产业技术研究院有限公司 | 基于混合导航带的移动机器人定位***及方法 |
CN108180912B (zh) * | 2017-12-31 | 2021-03-05 | 芜湖哈特机器人产业技术研究院有限公司 | 基于混合导航带的移动机器人定位***及方法 |
CN108196552A (zh) * | 2018-02-11 | 2018-06-22 | 成都兴联宜科技有限公司 | 一种智能小车的gps视觉导航*** |
CN108459600A (zh) * | 2018-02-11 | 2018-08-28 | 成都兴联宜科技有限公司 | 一种agv小车的视觉导航*** |
CN108196552B (zh) * | 2018-02-11 | 2021-03-02 | 深圳朝闻道智能信息科技有限公司 | 一种智能小车的gps视觉导航*** |
CN108804968A (zh) * | 2018-05-28 | 2018-11-13 | 重庆瑞耕达网络科技有限公司 | 一种agv二维码铺设装置 |
CN109709958A (zh) * | 2018-12-26 | 2019-05-03 | 南京航空航天大学 | 一种用于agv电磁导航控制***的可拓控制方法 |
CN109709958B (zh) * | 2018-12-26 | 2020-10-27 | 南京航空航天大学 | 一种用于agv电磁导航控制***的可拓控制方法 |
CN112987729A (zh) * | 2021-02-09 | 2021-06-18 | 灵动科技(北京)有限公司 | 用于控制自主移动机器人的方法和装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN206075136U (zh) | 基于模糊算法的视觉导航控制*** | |
CN106125740A (zh) | 基于模糊算法的视觉导航控制方法及*** | |
CN109753068A (zh) | 一种考虑通信情况的多usv群体协同避碰规划方法 | |
CN108021135A (zh) | 一种自动导引车的控制方法和装置 | |
CN106123922B (zh) | 基于比例微分调节的磁导航agv直行路线纠偏方法 | |
CN109506650B (zh) | 基于bp网络的agv导航行程偏差修正方法 | |
CN109427200A (zh) | 智能无人驾驶*** | |
US8437947B2 (en) | System and method for autonomous vehicle guiding using information technology infrastructure and server apparatus therefor | |
CN109357680A (zh) | 港口无人驾驶集装箱卡车高精地图生成方法 | |
CN104765368A (zh) | 一种基于模糊自适应算法的无人艇航向航速协同控制方法 | |
CN105759825A (zh) | 一种基于模糊pid的agv机器人定位控制算法 | |
Tang et al. | OdoNet: Untethered speed aiding for vehicle navigation without hardware wheeled odometer | |
CN112319473A (zh) | 带环境自适应能力的自动驾驶车辆纵向控制方法及*** | |
CN108944899A (zh) | 一种基于模糊控制的无人驾驶车辆转向盘控制***及方法 | |
CN101451849A (zh) | 移动体视觉导航用多功能路标及综合导航方法 | |
CN106292674A (zh) | 一种实时监控定位agv的方法 | |
Wu et al. | An overview of developments and challenges for unmanned surface vehicle autonomous berthing | |
CN111830972B (zh) | 一种船舶自主靠离泊控制方法、***、装置及存储介质 | |
CN116430856A (zh) | 一种基于变前视距离los算法的船舶航迹控制方法 | |
Jung et al. | Vision guidance system for AGV using ANFIS | |
Liu et al. | Motion control and positioning system of multi-sensor tunnel defect inspection robot: from methodology to application | |
CN109764874A (zh) | 一种变电站巡检车自主导航方法 | |
CN115373383A (zh) | 一种垃圾回收无人艇的自主避障方法、装置及相关设备 | |
CN114771562A (zh) | 一种无人驾驶车辆的控制方法及装置 | |
TWI670470B (zh) | 海上無人船舶航道修正系統及方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170405 Termination date: 20180829 |
|
CF01 | Termination of patent right due to non-payment of annual fee |