CN113237488A - 一种基于双目视觉和寻路缘技术的导航系统及导航方法 - Google Patents
一种基于双目视觉和寻路缘技术的导航系统及导航方法 Download PDFInfo
- Publication number
- CN113237488A CN113237488A CN202110525132.6A CN202110525132A CN113237488A CN 113237488 A CN113237488 A CN 113237488A CN 202110525132 A CN202110525132 A CN 202110525132A CN 113237488 A CN113237488 A CN 113237488A
- Authority
- CN
- China
- Prior art keywords
- module
- route
- submodule
- unit
- navigation
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 238000005516 engineering process Methods 0.000 title claims abstract description 25
- 239000011159 matrix material Substances 0.000 claims abstract description 25
- 238000004458 analytical method Methods 0.000 claims abstract description 16
- 238000000605 extraction Methods 0.000 claims description 20
- 230000001105 regulatory effect Effects 0.000 claims description 14
- 238000003384 imaging method Methods 0.000 claims description 13
- 230000003287 optical effect Effects 0.000 claims description 9
- 238000012937 correction Methods 0.000 claims description 7
- 230000001276 controlling effect Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000033001 locomotion Effects 0.000 claims description 4
- 230000005856 abnormality Effects 0.000 claims description 3
- 230000002238 attenuated effect Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000012502 risk assessment Methods 0.000 abstract 1
- 230000009471 action Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 241001391944 Commicarpus scandens Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Optics & Photonics (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于双目视觉和寻路缘技术的导航系统及导航方法，包括一级导航模块、二级导航模块、障碍避险模块和环境分析模块，其特征在于：所述一级导航模块用于获取装置的初始位置和目的地位置，并拟合出规划路线，所述二级导航模块用于判断路面实况，根据路面实际状况进行直行或转弯，所述障碍避险模块用于检测路面障碍，并实行有效规避，所述环境分析模块用于判断装置所处环境状况，并对危险环境发出警报，所述一级导航模块包括当前位置标定子模块、目的地位置输入子模块、等距点阵单元、路线规划子模块、指北单元和常用路线数据库子模块，本发明，具有精确导航和规避风险的特点。
Description
技术领域
本发明涉及导航技术领域，具体为一种基于双目视觉和寻路缘技术的导航系统及导航方法。
背景技术
随着现代化生产的快速发展，很多场合均采用机器人协助或代替人工完成很多枯燥、繁琐和危险的工作。在机器人工作时，需要机器人按照正确的轨迹运动实现自主导航，从而完成指定的工作。然而，机器人采用的这种自主导航方式对传感器的要求较高，增加了机器人的成本和结构复杂度，并且算法复杂，计算量大，容易出错。同时传统的导航系统通常为无线电导航系统或卫星导航系统，无线电导航系统必须辐射和接收无线电波，易被发现和干扰，需要载体外的导航台支持，一旦导航台失效，与之对应的导航设备无法使用，同时，也易发生故障。因此，设计精确导航和规避风险的一种基于双目视觉和寻路缘技术的导航系统及导航方法是很有必要的。
发明内容
本发明的目的在于提供一种基于双目视觉和寻路缘技术的导航系统及导航方法，以解决上述背景技术中提出的问题。
为了解决上述技术问题，本发明提供如下技术方案：一种基于双目视觉和寻路缘技术的导航系统及导航方法，包括一级导航模块、二级导航模块、障碍避险模块和环境分析模块，其特征在于：所述一级导航模块用于获取装置的初始位置和目的地位置，并拟合出规划路线，所述二级导航模块用于判断路面实况，根据路面实际状况进行直行或转弯，所述障碍避险模块用于检测路面障碍，并实行有效规避，所述环境分析模块用于判断装置所处环境状况，并对危险环境发出警报。
根据上述技术方案，所述一级导航模块包括当前位置标定子模块、目的地位置输入子模块、等距点阵单元、路线规划子模块、指北单元和常用路线数据库子模块，所述当前位置标定子模块用于标定装置当前所在位置，所述目的地位置输入子模块与当前位置标定子模块电连接，所述目的地位置输入子模块用于锁定目的地所在位置，使装置执行向目的地方向前行命令，所述等距点阵单元与目的地位置输入子模块电连接，所述等距点阵单元用于以装置为中心建立若干组定位点阵，所述路线规划子模块与等距点阵单元电连接，所述路线规划子模块用于规划当前位置至目的地位置的最佳路线，所述指北单元用于对装置行进时导向，所述常用路线数据库子模块用于根据导航起始点和终点的所在位置频率，找出频率较高的预先存储为经常使用的路线。
根据上述技术方案，所述一级导航模块的工作方法为：
S1.以当前位置标点为原点O，建立直角坐标系；
S2.在直角坐标系中确定目的地所在位置，并标定为终点P，原点O至终点P的距离标记为L；
S3.以原点O为圆心，L的长度为半径，接合周围路况建立等距点阵单元，使得每两组点单元间距均为100米；
S4.路线规划子模块在等距点阵单元内寻找O点至P点所需相连的最少点单元，并相连确定路线；
S5.指北单元记录路线方向角度数值；
S6.当连续重复有若干组点单元数量以及角度数值相等时，则录入常用路线数据库子模块；
S7.再次启动装置导航时，优先调用常用路线数据库子模块路线供使用者选择，若使用者确定此路线，则无需重复步骤S1-S6，若使用者否定此路线，则重复步骤S1-S6。
根据上述技术方案，所述二级导航模块包括双目图像采集子模块、长焦镜头子模块、判断单元一、调速单元、路缘识别子模块和路缘追踪子模块，所述双目图像采集子模块用于拍摄装置附近实际路况，并将实时成像显示画面传输至判断单元一，所述长焦镜头与双目图像采集子模块电连接，所述长焦镜头子模块用于拍摄装置远处路线装置，并成像传输至判断单元一，所述判断单元一与长焦镜头子模块电连接，所述判断单元一用于识别双目图像采集模块和长焦镜头模块成像，判断前方路况，并反馈信号至调速单元，所述调速单元与判断单元电连接，所述调速单元用于根据判断单元一的信号控制装置前行速度，所述路缘识别子模块与双目图像采集子模块和长焦镜头子模块电连接，所述路缘识别子模块用于提取双目图像采集子模块的成像信息，实时识别装置所在附近路缘信息，所述路缘追踪子模块与路缘识别子模块电连接，所述路缘追踪子模块用于控制装置跟随路缘信息追踪前行。
根据上述技术方案，所述二级导航模块的工作方法为：
A.利用双目图像采集子模块和长焦镜头子模块采集装置附近以及装置远处图像；
B.判断单元一根据图像信息判断路线附近是否存在异物以及前方100米内路线是否为直线；
C.当不存在异物且前方100米内路线均为直线时，调速单元调高装置前行速度；
D.当判断装置附近存在异物或者100米内路线存在弯曲时，调速单元调低装置前行速度，同时启动路缘识别子模块；
E.路缘识别子模块进一步识别双目图像采集子模块以及长焦镜头子模块中图像信息，提取路缘图像信息；
F.路缘追踪子模块控制装置前行方向，保证路缘识别子模块识别的路缘图像信息在成像中位置大小不变，实现追踪路缘作用。
根据上述技术方案，上述步骤B中，判断单元一的判断方法：
G.识别双目图像采集子模块和长焦镜头子模块前方路线的图像图层
H.将常规路线下的路线图层颜色记录；
I.当识别到的路线图层中出现其他颜色图层时或者识别到路线图层出现弯曲时，判定单元输出判定异常信号。
根据上述技术方案，所述障碍避险模块包括激光雷达扫描单元、特征提取子模块、判断单元二和路线调整单元，所述激光雷达扫描单元用于激光扫描装置附近异物，所述特征提取子模块与激光雷达扫描单元电连接，所述特征提取子模块用于提取判装置附近异物大小形态特征，所述判断单元二与特征提取子模块电连接，所述判断单元二用于判断装置附近的异物是否影响装置前行，所述路线调整单元与判断单元二电连接，所述路线调整单元与一级导航模块电连接，所述路线调整单元用于调整规划最新路线。
根据上述技术方案，所述障碍避险模块的工作方法为：
u.激光雷达扫描单元以装置为中心向前方发射扩散型激光点阵衰弱光信号；
v.特征提取子模块将对异物反馈的扩散型激光点阵衰弱光信号转化为数字电信号D；
w.通过公式求得数字电信号D值，判断单元根据D值，与异物通过最大值T作对比；
x.当D＞T时无法通过，路线调整单元以当前位置为原点O，重新启动一级导航模块规划路线，并自动排出当前所导航路线。
根据上述技术方案，所述上述步骤w中，异物数字电信号计算公式为：
其中D为雷达扫描单元扫描后特征提取子模块提取的数字电信号值，n为检测到异物光信号的个数，Lmin为光信号最小衰弱量，K为雷达扫描单元光信号转特征提取子模块电信号的固定系数。
根据上述技术方案，所述环境分析模块包括双目视觉校正模块和紧急位置信号发送子模块，所述双目视觉校正子模块用于对颠簸路面采集画质进行修复校正，所述紧急位置信号发送子模块用于对危险环境或装置受损时自动发送危险位置信息。
与现有技术相比，本发明所达到的有益效果是：本发明，通过设置有一级导航模块、二级导航模块、障碍避险模块和环境分析模块，可以有效提高对装置导航精确高效性和行驶路上的安全性，同时还实现了全自动化避险和紧急提示的作用。
附图说明
附图用来提供对本发明的进一步理解，并且构成说明书的一部分，与本发明的实施例一起用于解释本发明，并不构成对本发明的限制。在附图中：
图1是本发明的整体系统模块示意图；
图2是本发明的工作方法示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
请参阅图1-2，本发明提供技术方案：一种基于双目视觉和寻路缘技术的导航系统及导航方法，包括一级导航模块、二级导航模块、障碍避险模块和环境分析模块，其特征在于：一级导航模块用于获取装置的初始位置和目的地位置，并拟合出规划路线，二级导航模块用于判断路面实况，根据路面实际状况进行直行或转弯，障碍避险模块用于检测路面障碍，并实行有效规避，环境分析模块用于判断装置所处环境状况，并对危险环境发出警报；通过上述系统模块，可以有效提高对装置导航精确高效性和行驶路上的安全性，同时还实现了全自动化避险和紧急提示的作用。
一级导航模块包括当前位置标定子模块、目的地位置输入子模块、等距点阵单元、路线规划子模块、指北单元和常用路线数据库子模块，当前位置标定子模块用于标定装置当前所在位置，目的地位置输入子模块与当前位置标定子模块电连接，目的地位置输入子模块用于锁定目的地所在位置，使装置执行向目的地方向前行命令，等距点阵单元与目的地位置输入子模块电连接，等距点阵单元用于以装置为中心建立若干组定位点阵，路线规划子模块与等距点阵单元电连接，路线规划子模块用于规划当前位置至目的地位置的最佳路线，指北单元用于对装置行进时导向，常用路线数据库子模块用于根据导航起始点和终点的所在位置频率，找出频率较高的预先存储为经常使用的路线；优化了装置导航路线，同时设置有的常用路线数据库子模块，可以无需再次导航，快速锁定常用路线提高装置运行速率和简化操作。
一级导航模块的工作方法为：
S1.以当前位置标点为原点O，建立直角坐标系；
S2.在直角坐标系中确定目的地所在位置，并标定为终点P，原点O至终点P的距离标记为L；
S3.以原点O为圆心，L的长度为半径，接合周围路况建立等距点阵单元，使得每两组点单元间距均为100米；
S4.路线规划子模块在等距点阵单元内寻找O点至P点所需相连的最少点单元，并相连确定路线；
S5.指北单元记录路线方向角度数值；
S6.当连续重复有若干组点单元数量以及角度数值相等时，则录入常用路线数据库子模块；
S7.再次启动装置导航时，优先调用常用路线数据库子模块路线供使用者选择，若使用者确定此路线，则无需重复步骤S1-S6，若使用者否定此路线，则重复步骤S1-S6。
二级导航模块包括双目图像采集子模块、长焦镜头子模块、判断单元一、调速单元、路缘识别子模块和路缘追踪子模块，双目图像采集子模块用于拍摄装置附近实际路况，并将实时成像显示画面传输至判断单元一，长焦镜头与双目图像采集子模块电连接，长焦镜头子模块用于拍摄装置远处路线装置，并成像传输至判断单元一，判断单元一与长焦镜头子模块电连接，判断单元一用于识别双目图像采集模块和长焦镜头模块成像，判断前方路况，并反馈信号至调速单元，调速单元与判断单元电连接，调速单元用于根据判断单元一的信号控制装置前行速度，路缘识别子模块与双目图像采集子模块和长焦镜头子模块电连接，路缘识别子模块用于提取双目图像采集子模块的成像信息，实时识别装置所在附近路缘信息，路缘追踪子模块与路缘识别子模块电连接，路缘追踪子模块用于控制装置跟随路缘信息追踪前行；通过采集装置前行时的实时路况可以对装置实际矿进行调整，若装置前方路线笔直且无异物影响，则调高装置前行速度，提高装置效率，当装置前方存在异物时，则降速进行规避，当前方路线拐弯时，装置将锁定路缘，并降速，沿着路缘转弯角度实时转弯，相较于传动导航，达到导航更精确和行驶更安全的效果。
二级导航模块的工作方法为：
A.利用双目图像采集子模块和长焦镜头子模块采集装置附近以及装置远处图像；
B.判断单元一根据图像信息判断路线附近是否存在异物以及前方100米内路线是否为直线；
C.当不存在异物且前方100米内路线均为直线时，调速单元调高装置前行速度；
D.当判断装置附近存在异物或者100米内路线存在弯曲时，调速单元调低装置前行速度，同时启动路缘识别子模块；
E.路缘识别子模块进一步识别双目图像采集子模块以及长焦镜头子模块中图像信息，提取路缘图像信息；
F.路缘追踪子模块控制装置前行方向，保证路缘识别子模块识别的路缘图像信息在成像中位置大小不变，实现追踪路缘作用。
上述步骤B中，判断单元一的判断方法：
G.识别双目图像采集子模块和长焦镜头子模块前方路线的图像图层
H.将常规路线下的路线图层颜色记录；
I.当识别到的路线图层中出现其他颜色图层时或者识别到路线图层出现弯曲时，判定单元输出判定异常信号。
障碍避险模块包括激光雷达扫描单元、特征提取子模块、判断单元二和路线调整单元，激光雷达扫描单元用于激光扫描装置附近异物，特征提取子模块与激光雷达扫描单元电连接，特征提取子模块用于提取判装置附近异物大小形态特征，判断单元二与特征提取子模块电连接，判断单元二用于判断装置附近的异物是否影响装置前行，路线调整单元与判断单元二电连接，路线调整单元与一级导航模块电连接，路线调整单元用于调整规划最新路线；当行驶过程中遇到障碍物时，激光雷达扫描单元将检测障碍物的体积信息，可以判断是否通过，当不能规避障碍物通过时，路线调整单元可以从新规划其他路线，实现了导航过程中的可变性，避免装置到障碍物损坏装置。
障碍避险模块的工作方法为：
u.激光雷达扫描单元以装置为中心向前方发射扩散型激光点阵衰弱光信号；
v.特征提取子模块将对异物反馈的扩散型激光点阵衰弱光信号转化为数字电信号D；
w.通过公式求得数字电信号D值，判断单元根据D值，与异物通过最大值T作对比；
x.当D＞T时无法通过，路线调整单元以当前位置为原点O，重新启动一级导航模块规划路线，并自动排出当前所导航路线。
上述步骤w中，异物数字电信号计算公式为：
其中D为雷达扫描单元扫描后特征提取子模块提取的数字电信号值，n为检测到异物光信号的个数，Lmin为光信号最小衰弱量，K为雷达扫描单元光信号转特征提取子模块电信号的固定系数。
环境分析模块包括双目视觉校正模块和紧急位置信号发送子模块，双目视觉校正子模块用于对颠簸路面采集画质进行修复校正，紧急位置信号发送子模块用于对危险环境或装置受损时自动发送危险位置信息；在颠簸路面行驶时造成滑面抖动，双目视觉校正子模块可以智能修护抖动滑面，有助于判断路面信息，还可以在装置受损或过于抖动时，发送位置信号，实现报警的作用，提醒此处位置的危险性高。
需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。
最后应说明的是：以上仅为本发明的优选实施例而已，并不用于限制本发明，尽管参照前述实施例对本发明进行了详细的说明，对于本领域的技术人员来说，其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
Claims (10)
1.一种基于双目视觉和寻路缘技术的导航系统及导航方法，包括一级导航模块、二级导航模块、障碍避险模块和环境分析模块，其特征在于：所述一级导航模块用于获取装置的初始位置和目的地位置，并拟合出规划路线，所述二级导航模块用于判断路面实况，根据路面实际状况进行直行或转弯，所述障碍避险模块用于检测路面障碍，并实行有效规避，所述环境分析模块用于判断装置所处环境状况，并对危险环境发出警报。
2.根据权利要求1所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：所述一级导航模块包括当前位置标定子模块、目的地位置输入子模块、等距点阵单元、路线规划子模块、指北单元和常用路线数据库子模块，所述当前位置标定子模块用于标定装置当前所在位置，所述目的地位置输入子模块与当前位置标定子模块电连接，所述目的地位置输入子模块用于锁定目的地所在位置，使装置执行向目的地方向前行命令，所述等距点阵单元与目的地位置输入子模块电连接，所述等距点阵单元用于以装置为中心建立若干组定位点阵，所述路线规划子模块与等距点阵单元电连接，所述路线规划子模块用于规划当前位置至目的地位置的最佳路线，所述指北单元用于对装置行进时导向，所述常用路线数据库子模块用于根据导航起始点和终点的所在位置频率，找出频率较高的预先存储为经常使用的路线。
3.根据权利要求2所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：所述一级导航模块的工作方法为：
S1.以当前位置标点为原点O，建立直角坐标系；
S2.在直角坐标系中确定目的地所在位置，并标定为终点P，原点O至终点P的距离标记为L；
S3.以原点O为圆心，L的长度为半径，接合周围路况建立等距点阵单元，使得每两组点单元间距均为100米；
S4.路线规划子模块在等距点阵单元内寻找O点至P点所需相连的最少点单元，并相连确定路线；
S5.指北单元记录路线方向角度数值；
S6.当连续重复有若干组点单元数量以及角度数值相等时，则录入常用路线数据库子模块；
S7.再次启动装置导航时，优先调用常用路线数据库子模块路线供使用者选择，若使用者确定此路线，则无需重复步骤S1-S6，若使用者否定此路线，则重复步骤S1-S6。
4.根据权利要求3所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：所述二级导航模块包括双目图像采集子模块、长焦镜头子模块、判断单元一、调速单元、路缘识别子模块和路缘追踪子模块，所述双目图像采集子模块用于拍摄装置附近实际路况，并将实时成像显示画面传输至判断单元一，所述长焦镜头与双目图像采集子模块电连接，所述长焦镜头子模块用于拍摄装置远处路线装置，并成像传输至判断单元一，所述判断单元一与长焦镜头子模块电连接，所述判断单元一用于识别双目图像采集模块和长焦镜头模块成像，判断前方路况，并反馈信号至调速单元，所述调速单元与判断单元电连接，所述调速单元用于根据判断单元一的信号控制装置前行速度，所述路缘识别子模块与双目图像采集子模块和长焦镜头子模块电连接，所述路缘识别子模块用于提取双目图像采集子模块的成像信息，实时识别装置所在附近路缘信息，所述路缘追踪子模块与路缘识别子模块电连接，所述路缘追踪子模块用于控制装置跟随路缘信息追踪前行。
5.根据权利要求4所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：所述二级导航模块的工作方法为：
A.利用双目图像采集子模块和长焦镜头子模块采集装置附近以及装置远处图像；
B.判断单元一根据图像信息判断路线附近是否存在异物以及前方100米内路线是否为直线；
C.当不存在异物且前方100米内路线均为直线时，调速单元调高装置前行速度；
D.当判断装置附近存在异物或者100米内路线存在弯曲时，调速单元调低装置前行速度，同时启动路缘识别子模块；
E.路缘识别子模块进一步识别双目图像采集子模块以及长焦镜头子模块中图像信息，提取路缘图像信息；
F.路缘追踪子模块控制装置前行方向，保证路缘识别子模块识别的路缘图像信息在成像中位置大小不变，实现追踪路缘作用。
6.根据权利要求5所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：上述步骤B中，判断单元一的判断方法：
G.识别双目图像采集子模块和长焦镜头子模块前方路线的图像图层
H.将常规路线下的路线图层颜色记录；
I.当识别到的路线图层中出现其他颜色图层时或者识别到路线图层出现弯曲时，判定单元输出判定异常信号。
7.根据权利要求6所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：所述障碍避险模块包括激光雷达扫描单元、特征提取子模块、判断单元二和路线调整单元，所述激光雷达扫描单元用于激光扫描装置附近异物，所述特征提取子模块与激光雷达扫描单元电连接，所述特征提取子模块用于提取判装置附近异物大小形态特征，所述判断单元二与特征提取子模块电连接，所述判断单元二用于判断装置附近的异物是否影响装置前行，所述路线调整单元与判断单元二电连接，所述路线调整单元与一级导航模块电连接，所述路线调整单元用于调整规划最新路线。
8.根据权利要求7所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：所述障碍避险模块的工作方法为：
u.激光雷达扫描单元以装置为中心向前方发射扩散型激光点阵衰弱光信号；
v.特征提取子模块将对异物反馈的扩散型激光点阵衰弱光信号转化为数字电信号D；
w.通过公式求得数字电信号D值，判断单元根据D值，与异物通过最大值T作对比；
x.当D＞T时无法通过，路线调整单元以当前位置为原点O，重新启动一级导航模块规划路线，并自动排出当前所导航路线。
9.根据权利要求8所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：上述步骤w中，异物数字电信号计算公式为：
其中D为雷达扫描单元扫描后特征提取子模块提取的数字电信号值，n为检测到异物光信号的个数，Lmin为光信号最小衰弱量，K为雷达扫描单元光信号转特征提取子模块电信号的固定系数。
10.根据权利要求9所述的一种基于双目视觉和寻路缘技术的导航系统及导航方法，其特征在于：所述环境分析模块包括双目视觉校正模块和紧急位置信号发送子模块，所述双目视觉校正子模块用于对颠簸路面采集画质进行修复校正，所述紧急位置信号发送子模块用于对危险环境或装置受损时自动发送危险位置信息。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110525132.6A CN113237488A (zh) | 2021-05-14 | 2021-05-14 | 一种基于双目视觉和寻路缘技术的导航系统及导航方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110525132.6A CN113237488A (zh) | 2021-05-14 | 2021-05-14 | 一种基于双目视觉和寻路缘技术的导航系统及导航方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN113237488A true CN113237488A (zh) | 2021-08-10 |
Family
ID=77134203
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110525132.6A Pending CN113237488A (zh) | 2021-05-14 | 2021-05-14 | 一种基于双目视觉和寻路缘技术的导航系统及导航方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113237488A (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114013506A (zh) * | 2021-11-24 | 2022-02-08 | 北京汇通天下物联科技有限公司 | 一种弯道预警的方法、装置、电子设备及存储介质 |
| CN114990980A (zh) * | 2022-06-07 | 2022-09-02 | 仲恺农业工程学院 | 可规划路线并确认道路交通路面执行标识的全自动装置 |
Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20010009585A (ko) * | 1999-07-12 | 2001-02-05 | 김헌출 | 미장로봇을 위한 경로계획 생성방법 |
| US6370452B1 (en) * | 1999-12-08 | 2002-04-09 | Samuel T. Pfister | Autonomous vehicle transit system |
| CN102419178A (zh) * | 2011-09-05 | 2012-04-18 | 中国科学院自动化研究所 | 基于红外路标的移动机器人定位系统和方法 |
| CN102773862A (zh) * | 2012-07-31 | 2012-11-14 | 山东大学 | 用于室内移动机器人的快速精确定位系统及其工作方法 |
| CN103837147A (zh) * | 2014-03-13 | 2014-06-04 | 北京理工大学 | 主动红外点阵式人工路标及智能体定位系统及方法 |
| CN105929843A (zh) * | 2016-04-22 | 2016-09-07 | 天津城建大学 | 一种基于改进蚁群算法的机器人路径规划方法 |
| CN106292674A (zh) * | 2016-10-11 | 2017-01-04 | 芜湖哈特机器人产业技术研究院有限公司 | 一种实时监控定位agv的方法 |
| US20180149482A1 (en) * | 2016-11-30 | 2018-05-31 | Inventec Appliances (Pudong) Corporation | Method for navigating an automated guided vehicle |
| CN109024417A (zh) * | 2018-07-24 | 2018-12-18 | 长安大学 | 一种智能道路清扫车及其道路污染物识别方法和控制方法 |
| CN109084778A (zh) * | 2018-09-19 | 2018-12-25 | 大连维德智能视觉技术创新中心有限公司 | 一种基于双目视觉和寻路缘技术的导航系统及导航方法 |
| CN109085840A (zh) * | 2018-09-21 | 2018-12-25 | 大连维德智能视觉技术创新中心有限公司 | 一种基于双目视觉的车辆导航控制系统及控制方法 |
| CN110433503A (zh) * | 2019-08-29 | 2019-11-12 | 广东金贝贝智能机器人研究院有限公司 | 一种儿童成长用智能陪护机器人 |
| US20200327650A1 (en) * | 2019-04-11 | 2020-10-15 | Bank Of America Corporation | Computer architecture for emulating an irregular lattice correlithm object generator in a correlithm object processing system |
| CN111857121A (zh) * | 2020-03-20 | 2020-10-30 | 北京国泰蓝盾科技有限公司 | 基于惯导和激光雷达的巡逻机器人行走避障方法及系统 |
| CN112223268A (zh) * | 2020-09-29 | 2021-01-15 | 北京海益同展信息科技有限公司 | 机器人控制装置以及机器人 |
| NL2024662B1 (en) * | 2019-12-04 | 2021-04-20 | Univ Anhui Sci & Technology | Machine vision-based robot line-tracking navigation system |
-
2021
- 2021-05-14 CN CN202110525132.6A patent/CN113237488A/zh active Pending
Patent Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR20010009585A (ko) * | 1999-07-12 | 2001-02-05 | 김헌출 | 미장로봇을 위한 경로계획 생성방법 |
| US6370452B1 (en) * | 1999-12-08 | 2002-04-09 | Samuel T. Pfister | Autonomous vehicle transit system |
| CN102419178A (zh) * | 2011-09-05 | 2012-04-18 | 中国科学院自动化研究所 | 基于红外路标的移动机器人定位系统和方法 |
| CN102773862A (zh) * | 2012-07-31 | 2012-11-14 | 山东大学 | 用于室内移动机器人的快速精确定位系统及其工作方法 |
| CN103837147A (zh) * | 2014-03-13 | 2014-06-04 | 北京理工大学 | 主动红外点阵式人工路标及智能体定位系统及方法 |
| CN105929843A (zh) * | 2016-04-22 | 2016-09-07 | 天津城建大学 | 一种基于改进蚁群算法的机器人路径规划方法 |
| CN106292674A (zh) * | 2016-10-11 | 2017-01-04 | 芜湖哈特机器人产业技术研究院有限公司 | 一种实时监控定位agv的方法 |
| US20180149482A1 (en) * | 2016-11-30 | 2018-05-31 | Inventec Appliances (Pudong) Corporation | Method for navigating an automated guided vehicle |
| CN109024417A (zh) * | 2018-07-24 | 2018-12-18 | 长安大学 | 一种智能道路清扫车及其道路污染物识别方法和控制方法 |
| CN109084778A (zh) * | 2018-09-19 | 2018-12-25 | 大连维德智能视觉技术创新中心有限公司 | 一种基于双目视觉和寻路缘技术的导航系统及导航方法 |
| CN109085840A (zh) * | 2018-09-21 | 2018-12-25 | 大连维德智能视觉技术创新中心有限公司 | 一种基于双目视觉的车辆导航控制系统及控制方法 |
| US20200327650A1 (en) * | 2019-04-11 | 2020-10-15 | Bank Of America Corporation | Computer architecture for emulating an irregular lattice correlithm object generator in a correlithm object processing system |
| CN110433503A (zh) * | 2019-08-29 | 2019-11-12 | 广东金贝贝智能机器人研究院有限公司 | 一种儿童成长用智能陪护机器人 |
| NL2024662B1 (en) * | 2019-12-04 | 2021-04-20 | Univ Anhui Sci & Technology | Machine vision-based robot line-tracking navigation system |
| CN111857121A (zh) * | 2020-03-20 | 2020-10-30 | 北京国泰蓝盾科技有限公司 | 基于惯导和激光雷达的巡逻机器人行走避障方法及系统 |
| CN112223268A (zh) * | 2020-09-29 | 2021-01-15 | 北京海益同展信息科技有限公司 | 机器人控制装置以及机器人 |
Non-Patent Citations (4)
| Title |
|---|
| 袁晓明;郝明锐;: "煤矿辅助运输机器人关键技术研究", 工矿自动化, no. 08, 5 August 2020 (2020-08-05) * |
| 邓文君;叶景杨;张铁;: "面向机器人磨抛的激光点云获取及去噪算法", 光学学报, no. 08, 30 May 2016 (2016-05-30) * |
| 高如新: "基于ORB算法的双目视觉定位", 电子测量技术, no. 04, 15 April 2017 (2017-04-15) * |
| 魏代俊;向长城;: "粒子群算法在三维空间机器人路径规划中的应用", 南京师范大学学报(工程技术版), no. 03, 20 September 2008 (2008-09-20) * |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114013506A (zh) * | 2021-11-24 | 2022-02-08 | 北京汇通天下物联科技有限公司 | 一种弯道预警的方法、装置、电子设备及存储介质 |
| CN114013506B (zh) * | 2021-11-24 | 2022-08-02 | 北京汇通天下物联科技有限公司 | 一种弯道预警的方法、装置、电子设备及存储介质 |
| CN114990980A (zh) * | 2022-06-07 | 2022-09-02 | 仲恺农业工程学院 | 可规划路线并确认道路交通路面执行标识的全自动装置 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US9092677B2 (en) | Apparatus and method for recognizing location of vehicle | |
| KR101610502B1 (ko) | 자율주행차량의 주행환경 인식장치 및 방법 | |
| CN113237488A (zh) | 一种基于双目视觉和寻路缘技术的导航系统及导航方法 | |
| US7376247B2 (en) | Target detection system using radar and image processing | |
| JP2844240B2 (ja) | 自動走行装置 | |
| EP3699716A1 (en) | Low-cost autonomous driving shuttle and a method of operating same | |
| US20180022351A1 (en) | Travelled-route selecting apparatus and method | |
| CN106740841A (zh) | 基于动态控制的车道线检测方法、装置及车载设备 | |
| EP0697641A2 (en) | Lane image processing system for vehicle | |
| US10679077B2 (en) | Road marking recognition device | |
| CN206623754U (zh) | 车道线检测装置 | |
| JP2005121641A (ja) | 人工標識生成方法、移動ロボットの自己位置及び方位角の推定方法、移動ロボットの自己位置及び方位角の推定装置、移動ロボット及び推定プログラム | |
| CN112857360B (zh) | 一种船舶航行多信息融合方法 | |
| CN110018688B (zh) | 基于视觉的自动引导车定位方法 | |
| US11562577B2 (en) | Method of detecting curved lane through path estimation using monocular vision camera | |
| JPH03265007A (ja) | 自動走行装置 | |
| JP3617709B2 (ja) | 距離計測装置 | |
| JP2007274037A (ja) | 障害物認識方法及び障害物認識装置 | |
| CN113960591A (zh) | 一种基于智能识别技术的无人船光电智能侦察方法 | |
| CN107305380A (zh) | 一种自动避障方法和装置 | |
| CN105752154A (zh) | 车辆转向控制系统及方法 | |
| JP2004347471A (ja) | 先行車両検出装置 | |
| JP3384278B2 (ja) | 距離計測装置 | |
| JP3440956B2 (ja) | 車両用走行路検出装置 | |
| US20220189179A1 (en) | Object position detection device, travel control system, and travel control method |
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 |