CN110412982A - 基于单目相机测距不确定的机器人路径稳健性规划方法 - Google Patents
基于单目相机测距不确定的机器人路径稳健性规划方法 Download PDFInfo
- Publication number
- CN110412982A CN110412982A CN201910702919.8A CN201910702919A CN110412982A CN 110412982 A CN110412982 A CN 110412982A CN 201910702919 A CN201910702919 A CN 201910702919A CN 110412982 A CN110412982 A CN 110412982A
- Authority
- CN
- China
- Prior art keywords
- path
- monocular camera
- uncertain
- barrier
- vertical line
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 46
- 230000004888 barrier function Effects 0.000 claims abstract description 33
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 22
- 238000005457 optimization Methods 0.000 claims abstract description 21
- 241000254158 Lampyridae Species 0.000 claims abstract description 11
- 230000007613 environmental effect Effects 0.000 claims abstract description 6
- 238000005070 sampling Methods 0.000 claims description 21
- 238000005259 measurement Methods 0.000 claims description 17
- 238000000342 Monte Carlo simulation Methods 0.000 claims description 7
- 241000131894 Lampyris noctiluca Species 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 6
- 239000012141 concentrate Substances 0.000 claims description 3
- 238000009826 distribution Methods 0.000 claims description 2
- 238000005520 cutting process Methods 0.000 abstract description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- PCHJSUWPFVWCPO-UHFFFAOYSA-N gold Chemical compound [Au] PCHJSUWPFVWCPO-UHFFFAOYSA-N 0.000 description 1
- 239000010931 gold Substances 0.000 description 1
- 229910052737 gold Inorganic materials 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Classifications
-
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Image Analysis (AREA)
- Measurement Of Optical Distance (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于单目相机测距不确定的机器人路径稳健性规划方法,包括以下步骤:第一步,在已有的像素点环境模型的基础上,将路径起点与目标点的连线方向等间距切分路径,形成完整的路径;第二步,以路径长度最短为目标函数,以不与障碍物发生碰撞为约束条件,构建不确定性优化模型;第三步,针对路径规划不确定优化模型建立亮度函数,基于亮度函数利用萤火虫智能算法求解路径规划问题,输出最优路径。本发明针对路径规划不确定优化模型建立亮度函数,考虑路径长度和路径安全度两个指标,使得该方法不仅有很好的避障功能且能规划出较短的路径。
Description
技术领域
本发明涉及一种机器人路径规划方法,特别涉及一种基于单目相机测距不确定的机器人路径稳健性规划方法。
背景技术
路径规划是指在分布有障碍物的环境中,找到从起始点到目标点的最合理、高效的避障路径,路径规划是移动机器人导航中的关键技术之一。现有的路径规划方法分为经典路径规划和智能路径规划,经典路径规划如:人工势场法、概率地图法和快速搜索随机树法等,经典路径规划方法有时不能产生最优路径,而且往往被锁定在局部极小值中。在存在多个障碍物或动态环境下,其中一些可能无法提供合适的解决方案。
因此,经典路径规划已经逐渐被智能路径规划所取代。现有的智能路径规划算法包括粒子群算法、蚁群算法、遗传算法及萤火虫算法等。其中萤火虫算法因其算法结构简单,求解能力强适用于优化复杂问题等特点,受到了许多学者关注和研究。基于萤火虫智能方法的路径规划方法实质是在避开障碍物的前提下,根据路径规划的目标函数,按照萤火中的寻优规则,更新机器人的运动方向。
在机器人每一步动态路径规划过程中,都必须知道机器人与障碍物的距离,已有的路径规划方法都将此变量在数学模型上处理成一个确定变量。其实由于光线或测量方法、仪器精度等变量,该变量具有一定的不确定性。目前,针对路径规划中不确定的研究,学者们常常关注于不确定未知环境和不确定动态环境的情况,包括目标点处于动态不确定的情况、障碍物处于动态不确定或者未知情况,例如申请号为201210376358.5的发明专利,提供了一种面向混合地形区域不确定环境的机器人全局路径规划方法;申请号为200910226707.3的发明专利,提供了一种水下清洗作业机器人未知环境路径规划方法;申请号为201310195535.4的发明专利,提供了一种动态环境下移动机器人路径规划方法。
学者们少有研究在路径规划过程中考虑移动机器人对外界环境感知的不确定性对于路径规划的影响。路径规划时忽视测量不确定的影响会增加机器人在实际移动过程中与障碍物发生碰撞的风险。因此,在路径规划中研究机器人环境感知的不确定性有着非常重要的意义。
申请号为201710019066.9的发明专利,公开了一种存在测量不确定性下的反馈路径规划方法,其通过考虑测量不确定性对于反馈吸引域的影响,采用庞德里亚金集差缩小了吸引域的大小,重新评估路径规划过程中的安全避障问题,并采用GP算法在线估计吸引域大小从而克服吸引域计算缓慢的缺陷。
发明内容
为了解决上述技术问题,本发明提供一种算法简单、准确度高的基于单目相机测距不确定的机器人路径稳健性规划方法。
本发明解决上述问题的技术方案是:一种基于单目相机测距不确定的机器人路径稳健性规划方法,包括以下步骤:
第一步,建立地图模型:在已有的像素点环境模型的基础上,连接路径起点与目标点,以路径起点与目标点连线方向等间距划分n条垂直于连线的垂线,在每条垂线上各取样一个点,得到一个n维点集,将n维点集中相邻两点用直线连接起来即得到一条完整的路径,以路径起点为原点,路径起点与目标点连线方向为横坐标,垂线方向为纵坐标建立坐标轴;重复第一步,得到N条路径;
第二步,构建不确定性优化模型:以路径长度最短为目标函数,以不与障碍物发生碰撞为约束条件,构建不确定性优化模型;
第三步,求解不确定性优化模型:针对路径规划不确定优化模型建立亮度函数,基于亮度函数利用萤火虫智能算法求解路径规划问题,输出最优路径。
上述基于单目相机测距不确定的机器人路径稳健性规划方法,所述第一步中,记等间距划分的n条垂直于连线的垂线为(l1,l2,…,ln),得到的n维点集为(ph1,ph2,…,phn),得到完整的路径为path=(ST,ph1,ph2,…,phn,TA),其中ST为起点,TA为终点。
上述基于单目相机测距不确定的机器人路径稳健性规划方法,所述第二步中,不确定性优化模型具体表达式为:
min
s.t.
hL≤h≤hU,
其中L(path)为路径长度,phi,phi+1分别为第i条垂线、第i+1条垂线上的纵坐标值,为第i条垂线与第i+1条垂线之间路径的长度,l0为相邻两点的固定水平间隔;dis为路径与障碍物之间的距离,f为单目相机焦距,h为相机固定高度,ypix为图像中障碍物底部与图像水平中心线的像素距离。
上述基于单目相机测距不确定的机器人路径稳健性规划方法,第三步中的亮度函数为:
其中α1为长度系数,α2为风险系数,且α1+α2=1,Light(pathj)为第j条路径的亮度函数,j=1,2…N,L(pathj)为第j条路径的路径长度,D(pathj)为第j条路径的路径风险,路径长度的计算公式为路径风险的计算公式为其中dismin(phi,phi+1)为第i条垂线与第i+1条垂线之间路径与障碍物之间最短距离。
上述基于单目相机测距不确定的机器人路径稳健性规划方法,第三步中利用萤火虫智能算法求解路径规划问题的步骤为:
S1:初始化萤火虫算法参数;
S2:随机初始化路径并计算路径亮度;
S3:比较路径亮度,根据路径亮度更新路径位置;
S4:采用蒙特卡罗方法评估路径与障碍物之间距离并更新路径亮度;
S5:重复S2-S4直至达到迭代次数后输出最优路径。
上述基于单目相机测距不确定的机器人路径稳健性规划方法,步骤S4中采用蒙特卡罗方法评估路径与障碍物之间距离的过程为:单目相机测距公式:焦距测量随机变量F~N(μ,σ2),其中u为期望值,σ为标准差,高度测量随机变量H~U(hL,hU),其中hL为高度测量值下限,其中hU为高度测量值上限,像素距离随机变量其中为像素距离值下限,其中为像素距离值上限,从标准正态分布中随机抽样M次得到焦距抽样合集fm(fm1,fm2,…,fmm),fmm为第M次抽样得到的焦距测量值,从标准均匀分布中随机抽样M次分别得到高度抽样合集hm(hm1,hm2,…,hmm)和像素距离抽样合集pixm(pixm1,pixm2,…,pixmm),hmm为第M次抽样得到的高度测量值,pixmm为第M次抽样得到的像素距离测量值;分别计算Fm=μ+σfm,Hm=hL+(hU-hL)hm和其中Fm为焦距不确定度分量,Hm为高度不确定度分量,PIXm为像素距离不确定度分量;依据单目相机测距公式计算mean(DISm)为路径与障碍物的距离测量的评估值。
本发明的有益效果在于:本发明首先建立地图模型,在已有的像素点环境模型的基础上,对以路径起点与目标点的连线方向等间距切分路径,从而保证每条路径的维数一致;然后以路径长度最短为目标函数,以不与障碍物发生碰撞为约束条件,构建不确定性优化模型;最后求解不确定性优化模型:针对路径规划不确定优化模型建立亮度函数,考虑路径长度和路径安全度两个指标,使得该方法不仅有很好的避障功能且能规划出较短的路径,在路径规划过程中采用蒙特卡罗方法评估路径与障碍物之间的距离,利用萤火虫智能算法求解路径规划问题,输出最优路径,采用蒙特卡罗方法对单目相机测距的测量值进行评估,评估的结果考虑了测量的不确定性,减小了测量的不确定性对路径规划的影响,在机器人实际移动过程中具有更强的可行性。
附图说明
图1为本发明的流程图。
图2为本发明的萤火虫智能算法的流程图。
图3为本发明实施例中建立的地图模型的示意图。
图4为使用本发明方法的路径规划效果图。
具体实施方式
下面结合附图和实施例对本发明作进一步的说明。
如图2、图3所示,路径规划的环境模型为二维平面的正方形,障碍物为静态障碍物,可以根据实际场景描述;路径规划的总体流程图如图1所示。
一种基于单目相机测距不确定的机器人路径稳健性规划方法,包括以下步骤:
第一步,建立地图模型:路径规划计算域为300*500的像素点矩形,相邻两个像素点的距离代表1CM物理距离,因此环境地图的区域为300CM*500CM,在已有的像素点环境模型的基础上,连接路径起点与目标点,以路径起点与目标点连线方向以40CM为间距等间距划分11条垂直于连线的垂线并记为(l1,l2,…,l11),在每条垂线上各取样一个点,得到一个11维点集(ph1,ph2,…,ph11),将11维点集中相邻两点用直线连接起来即得到一条完整的路径,path=(ST,ph1,ph2,…,ph11,TA),其中ST为起点,坐标为(10,150),TA为终点,坐标为(490,150),因此路径规划问题转化为11维点集(ph1,ph2,…,ph11)的优化问题。以路径起点为原点,路径起点与目标点连线方向为横坐标,垂线方向为纵坐标建立坐标轴;重复第一步,得到N条路径;
第二步,构建不确定性优化模型:以路径长度最短为目标函数,以不与障碍物发生碰撞为约束条件,构建不确定性优化模型;
不确定性优化模型具体表达式为:
min
s.t.
hL≤h≤hU,
其中L(path)为路径长度,phi,phi+1分别为第i条垂线、第i+1条垂线上的纵坐标值,为第i条垂线与第i+1条垂线之间路径的长度,l0为相邻两点的固定水平间隔,dis为路径与障碍物之间的距离,f为单目相机焦距,f=50mm,h为相机固定高度,h=100mm,ypix为图像中障碍物底部与图像水平中心线的像素距离。
第三步,求解不确定性优化模型:针对路径规划不确定优化模型建立亮度函数,基于亮度函数利用萤火虫智能算法求解路径规划问题,输出最优路径。
亮度函数为:
其中α1为长度系数,α2为风险系数,且α1+α2=1,α1=0.55,α2=0.45,Light(pathj)为第j条路径的亮度函数,j=1,2…N,L(pathj)为第j条路径的路径长度,D(pathj)为第j条路径的路径风险,路径长度的计算公式为其中phi,phi+1分别为第i条垂线、第i+1条垂线上的纵坐标值,路径风险的计算公式为其中dismin(phi,phi+1)为第i条垂线与第i+1条垂线之间路径与障碍物之间最短距离。
利用萤火虫智能算法求解路径规划问题的步骤为:
S1:初始化萤火虫算法参数;
S2:随机初始化路径并计算路径亮度;
S3:比较路径亮度,根据路径亮度更新路径位置;
S4:采用蒙特卡罗方法评估路径与障碍物之间距离并更新路径亮度;
S5:重复S2-S4直至达到迭代次数后输出最优路径。
采用蒙特卡罗方法评估路径与障碍物之间距离的过程为:单目相机测距公式:焦距测量随机变量F~N(μ,σ2),其中u为期望值,σ为标准差,高度测量随机变量H~U(hL,hU),其中hL为高度测量值下限,其中hU为高度测量值上限,像素距离随机变量其中为像素距离值下限,其中为像素距离值上限,从标准正态分布中随机抽样M次得到焦距抽样合集fm(fm1,fm2,…,fmm),fmm为第M次抽样得到的焦距测量值,从标准均匀分布中随机抽样M次分别得到高度抽样合集hm(hm1,hm2,…,hmm)和像素距离抽样合集pixm(pixm1,pixm2,…,pixmm),hmm为第M次抽样得到的高度测量值,pixmm为第M次抽样得到的像素距离测量值;分别计算Fm=μ+σfm,Hm=hL+(hU-hL)hm和其中Fm为焦距不确定度分量,Hm为高度不确定度分量,PIXm为像素距离不确定度分量;依据单目相机测距公式计算mean(DISm)为路径与障碍物的距离测量的评估值。
与现有技术相比,本发明的优点在于:本发明涉及一种基于单目相机测距不确定的机器人路径稳健性规划方法,构建了一种新的萤火虫算法亮度函数,考虑路径长度和路径安全度两个指标,使得该方法不仅有很好的避障功能且能规划出较短的路径。采用蒙特卡罗方法对单目相机测距的测量值进行评估,评估的结果考虑了测量的不确定性,在机器人实际移动过程中具有更强的可行性。图3为仿真实验结果。
Claims (6)
1.一种基于单目相机测距不确定的机器人路径稳健性规划方法,包括以下步骤:
第一步,建立地图模型:在已有的像素点环境模型的基础上,连接路径起点与目标点,以路径起点与目标点连线方向等间距划分n条垂直于连线的垂线,在每条垂线上各取样一个点,得到一个n维点集,将n维点集中相邻两点用直线连接起来即得到一条完整的路径,以路径起点为原点,路径起点与目标点连线方向为横坐标,垂线方向为纵坐标建立坐标轴;重复第一步,得到N条路径;
第二步,构建不确定性优化模型:以路径长度最短为目标函数,以不与障碍物发生碰撞为约束条件,构建不确定性优化模型;
第三步,求解不确定性优化模型:针对路径规划不确定优化模型建立亮度函数,基于亮度函数利用萤火虫智能算法求解路径规划问题,输出最优路径。
2.根据权利要求1所述的基于单目相机测距不确定的机器人路径稳健性规划方法,其特征在于,所述第一步中,记等间距划分的n条垂直于连线的垂线为(l1,l2,…,ln),得到的n维点集为(ph1,ph2,…,phn),得到完整的路径为path=(ST,ph1,ph2,…,phn,TA),其中ST为起点,TA为终点。
3.根据权利要求2所述的基于单目相机测距不确定的机器人路径稳健性规划方法,其特征在于,所述第二步中,不确定性优化模型具体表达式为:
其中L(path)为路径长度,phi,phi+1分别为第i条垂线、第i+1条垂线上的纵坐标值,为第i条垂线与第i+1条垂线之间路径的长度,l0为相邻两点的固定水平间隔;dis为路径与障碍物之间的距离,f为单目相机焦距,h为相机固定高度,ypix为图像中障碍物底部与图像水平中心线的像素距离。
4.根据权利要求3所述的一种基于单目相机测距不确定的机器人路径稳健性规划方法,其特征在于,第三步中的亮度函数为:
其中α1为长度系数,α2为风险系数,且α1+α2=1,Light(pathj)为第j条路径的亮度函数,j=1,2…N,L(pathj)为第j条路径的路径长度,D(pathj)为第j条路径的路径风险,路径长度的计算公式为路径风险的计算公式为其中dismin(phi,phi+1)为第i条垂线与第i+1条垂线之间路径与障碍物之间最短距离。
5.根据权利要求4所述的基于单目相机测距不确定的机器人路径稳健性规划方法,其特征在于,第三步中利用萤火虫智能算法求解路径规划问题的步骤为:
S1:初始化萤火虫算法参数;
S2:随机初始化路径并计算路径亮度;
S3:比较路径亮度,根据路径亮度更新路径位置;
S4:采用蒙特卡罗方法评估路径与障碍物之间距离并更新路径亮度;
S5:重复S2-S4直至达到迭代次数后输出最优路径。
6.根据权利要求5所述的基于单目相机测距不确定的机器人路径稳健性规划方法,其特征在于,步骤S4中采用蒙特卡罗方法评估路径与障碍物之间距离的过程为:单目相机测距公式:焦距测量随机变量F~N(μ,σ2),其中u为期望值,σ为标准差,高度测量随机变量H~U(hL,hU),其中hL为高度测量值下限,其中hU为高度测量值上限,像素距离随机变量其中为像素距离值下限,其中为像素距离值上限,从标准正态分布中随机抽样M次得到焦距抽样合集fm(fm1,fm2,…,fmm),fmm为第M次抽样得到的焦距测量值,从标准均匀分布中随机抽样M次分别得到高度抽样合集hm(hm1,hm2,…,hmm)和像素距离抽样合集pixm(pixm1,pixm2,…,pixmm),hmm为第M次抽样得到的高度测量值,pixmm为第M次抽样得到的像素距离测量值;分别计算Fm=μ+σfm,Hm=hL+(hU-hL)hm和其中Fm为焦距不确定度分量,Hm为高度不确定度分量,PIXm为像素距离不确定度分量;依据单目相机测距公式计算mean(DISm)为路径与障碍物的距离测量的评估值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910702919.8A CN110412982B (zh) | 2019-07-31 | 2019-07-31 | 基于单目相机测距不确定的机器人路径稳健性规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910702919.8A CN110412982B (zh) | 2019-07-31 | 2019-07-31 | 基于单目相机测距不确定的机器人路径稳健性规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110412982A true CN110412982A (zh) | 2019-11-05 |
CN110412982B CN110412982B (zh) | 2022-07-15 |
Family
ID=68364802
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910702919.8A Active CN110412982B (zh) | 2019-07-31 | 2019-07-31 | 基于单目相机测距不确定的机器人路径稳健性规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110412982B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112101655A (zh) * | 2020-09-11 | 2020-12-18 | 长沙理工大学 | 萤火虫算法在路径规划应用中的种群动态调节策略与实现 |
CN115357034A (zh) * | 2022-10-21 | 2022-11-18 | 上海伯镭智能科技有限公司 | 基于智慧交通的无人驾驶矿车转向控制方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006031313A (ja) * | 2004-07-15 | 2006-02-02 | Daihatsu Motor Co Ltd | 障害物測定方法及び障害物測定装置 |
CN102360214A (zh) * | 2011-09-02 | 2012-02-22 | 哈尔滨工程大学 | 一种基于萤火虫算法的舰船路径规划方法 |
CN102768536A (zh) * | 2012-07-20 | 2012-11-07 | 哈尔滨工程大学 | 一种基于多目标萤火虫算法的路径规划方法 |
DE102011083745A1 (de) * | 2011-09-29 | 2013-04-04 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zum monokularen Motion-Stereo-basierten automatischen Vermessen von freien Parkplätzen |
CN103895023A (zh) * | 2014-04-04 | 2014-07-02 | 中国民航大学 | 一种基于编码方位装置的机械臂末端跟踪测量系统及方法 |
CN105488454A (zh) * | 2015-11-17 | 2016-04-13 | 天津工业大学 | 基于单目视觉的前方车辆检测与测距 |
CN105955259A (zh) * | 2016-04-29 | 2016-09-21 | 南京航空航天大学 | 基于多窗口实时测距的单目视觉agv的精确定位方法及系统 |
CN106153000A (zh) * | 2016-06-17 | 2016-11-23 | 合肥工业大学 | 一种前方车辆距离检测方法 |
WO2017215044A1 (zh) * | 2016-06-14 | 2017-12-21 | 广东技术师范学院 | 一种移动机器人的自动规划路径方法及移动机器人 |
CN109297498A (zh) * | 2018-10-11 | 2019-02-01 | 南昌工程学院 | 一种基于改进多目标萤火虫算法的机器人路径规划方法 |
CN109657863A (zh) * | 2018-12-20 | 2019-04-19 | 智慧航海(青岛)科技有限公司 | 一种基于萤火虫算法的无人船全局路径动态优化方法 |
-
2019
- 2019-07-31 CN CN201910702919.8A patent/CN110412982B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006031313A (ja) * | 2004-07-15 | 2006-02-02 | Daihatsu Motor Co Ltd | 障害物測定方法及び障害物測定装置 |
CN102360214A (zh) * | 2011-09-02 | 2012-02-22 | 哈尔滨工程大学 | 一种基于萤火虫算法的舰船路径规划方法 |
DE102011083745A1 (de) * | 2011-09-29 | 2013-04-04 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zum monokularen Motion-Stereo-basierten automatischen Vermessen von freien Parkplätzen |
CN102768536A (zh) * | 2012-07-20 | 2012-11-07 | 哈尔滨工程大学 | 一种基于多目标萤火虫算法的路径规划方法 |
CN103895023A (zh) * | 2014-04-04 | 2014-07-02 | 中国民航大学 | 一种基于编码方位装置的机械臂末端跟踪测量系统及方法 |
CN105488454A (zh) * | 2015-11-17 | 2016-04-13 | 天津工业大学 | 基于单目视觉的前方车辆检测与测距 |
CN105955259A (zh) * | 2016-04-29 | 2016-09-21 | 南京航空航天大学 | 基于多窗口实时测距的单目视觉agv的精确定位方法及系统 |
WO2017215044A1 (zh) * | 2016-06-14 | 2017-12-21 | 广东技术师范学院 | 一种移动机器人的自动规划路径方法及移动机器人 |
CN106153000A (zh) * | 2016-06-17 | 2016-11-23 | 合肥工业大学 | 一种前方车辆距离检测方法 |
CN109297498A (zh) * | 2018-10-11 | 2019-02-01 | 南昌工程学院 | 一种基于改进多目标萤火虫算法的机器人路径规划方法 |
CN109657863A (zh) * | 2018-12-20 | 2019-04-19 | 智慧航海(青岛)科技有限公司 | 一种基于萤火虫算法的无人船全局路径动态优化方法 |
Non-Patent Citations (2)
Title |
---|
李凤玲等: "基于萤火虫算法动态未知环境的路径规划", 《自动化仪表》 * |
贺若飞等: "基于蒙特卡罗卡尔曼滤波的无人机目标定位方法", 《西北工业大学学报》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112101655A (zh) * | 2020-09-11 | 2020-12-18 | 长沙理工大学 | 萤火虫算法在路径规划应用中的种群动态调节策略与实现 |
CN112101655B (zh) * | 2020-09-11 | 2023-04-28 | 长沙理工大学 | 萤火虫算法在路径规划应用中的种群动态调节策略与实现 |
CN115357034A (zh) * | 2022-10-21 | 2022-11-18 | 上海伯镭智能科技有限公司 | 基于智慧交通的无人驾驶矿车转向控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110412982B (zh) | 2022-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102210715B1 (ko) | 도로 중의 차도선을 확정하기 위한 방법, 장치 및 기기 | |
US20220028163A1 (en) | Computer Vision Systems and Methods for Detecting and Modeling Features of Structures in Images | |
CN103198302B (zh) | 一种基于双模态数据融合的道路检测方法 | |
CN101509781B (zh) | 基于单目摄像头的步行机器人定位系统 | |
CN103632167B (zh) | 类地重力场环境下单目视觉空间识别方法 | |
CN103377471B (zh) | 物体定位方法和装置、最优摄像机对确定方法和装置 | |
CN110412982A (zh) | 基于单目相机测距不确定的机器人路径稳健性规划方法 | |
CN113345019A (zh) | 一种输电线路通道隐患目标测距方法、设备及介质 | |
CN112001958A (zh) | 基于有监督单目深度估计的虚拟点云三维目标检测方法 | |
CN111598942A (zh) | 一种用于对电力设施仪表进行自动定位的方法及系统 | |
CN114066985B (zh) | 一种输电线隐患距离的计算方法及终端 | |
CN110443830A (zh) | 一种基于混合高斯背景模型的降水云团检测方法 | |
CN109684910A (zh) | 一种网络检测输电线路地表环境变化的方法及系统 | |
JP6322564B2 (ja) | 点群解析処理装置、方法、及びプログラム | |
Nguyen et al. | Toward real-time vehicle detection using stereo vision and an evolutionary algorithm | |
CN108460422B (zh) | 基于深度分布特征的海底地貌类型识别方法 | |
CN110796380B (zh) | 大尺度下基于栅格数据的交通通达度评价方法 | |
CN115808129B (zh) | 一种机器视觉识别发电机母线位移和形变的方法 | |
Shan et al. | Feasibility of Accurate Point Cloud Model Reconstruction for Earthquake-Damaged Structures Using UAV-Based Photogrammetry | |
Rufei et al. | Research on a pavement pothole extraction method based on vehicle-borne continuous laser scanning point cloud | |
CN115166702A (zh) | 一种基于高精度定位信息的激光雷达到车体坐标系的自动标定方法及装置 | |
Arastounia et al. | Simultaneous identification, modeling and registration refinement of poles using laser scanning point clouds | |
CN111123279B (zh) | 一种融合nd和icp匹配的移动机器人重定位方法 | |
CN105631063B (zh) | 一种基于目标特征的交汇时刻预报方法 | |
CN114299283B (zh) | 一种基于图像的位移测量方法及系统 |
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 |