CN107622502A - 复杂光照条件下视觉导引系统的路径提取与识别方法 - Google Patents

复杂光照条件下视觉导引系统的路径提取与识别方法 Download PDF

Info

Publication number
CN107622502A
CN107622502A CN201710627847.6A CN201710627847A CN107622502A CN 107622502 A CN107622502 A CN 107622502A CN 201710627847 A CN201710627847 A CN 201710627847A CN 107622502 A CN107622502 A CN 107622502A
Authority
CN
China
Prior art keywords
illumination
image
path
pixel
component
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
Application number
CN201710627847.6A
Other languages
English (en)
Other versions
CN107622502B (zh
Inventor
武星
楼佩煌
张颖
王龙军
钱晓明
李林慧
陈华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201710627847.6A priority Critical patent/CN107622502B/zh
Publication of CN107622502A publication Critical patent/CN107622502A/zh
Application granted granted Critical
Publication of CN107622502B publication Critical patent/CN107622502B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明公开了一种复杂光照条件下视觉导引系统的路径提取与识别方法，首先通过分析光照照度与图像亮度分量的关系，建立表征图像色彩分布规律的光照色彩模型。其次设计一种区分复杂光照路径图像中高亮光区域、正常照度区域和暗阴影区域的图像照度分类器，在RGB色彩空间对低照度区域进行图像增强以还原路径色彩信息，在高亮光区域对色度分量Cb与Cr进行差分运算以抑制共模照度干扰，再进行自适应阈值分割。最后采用粒子群优化方法识别导引路径的最优参数模型。本发明的方法可显著提高视觉导引系统在复杂光照下提取、识别导引路径的精确性、可靠性和智能性。

Description

复杂光照条件下视觉导引系统的路径提取与识别方法
技术领域
本发明属于计算机视觉检测及移动机器人视觉导航技术领域，具体指代一种复杂光照条件下视觉导引系统的路径提取与识别方法。
背景技术
自动导引车(Automated guided vehicle，AGV)是一种可沿指定路径自动行驶并在不同工位点之间进行物料搬运的移动机器人，已广泛应用于汽车、电子、仓储和食品等行业的生产物流输送。相比于其它导引方式，视觉导引技术具有路径布局柔性大、测量精度高、设置成本低等优点。然而机器视觉系统的识别性能易受复杂环境光照变化的影响，在作业现场复杂多变的光照条件下实现机器视觉系统的稳定可靠运行，是提升视觉导引AGV复杂环境适应性的关键技术。
基于视觉的自动导引车，其导引路径识别过程包括两个环节：路径特征提取和导引参数测量，而路径特征提取的精确性直接影响导引参数测量的精度。
在视觉导引AGV的运行过程中，车载摄像机采集导引路径图像时需依靠视觉照明系统提供光照条件。而运行环境中不同地点的光照条件可能不断发生变化，并可能存在地面反光、强光照、暗阴影以及光照突变等各种复杂光照干扰现象，严重影响了车载摄像机所采集的导引路径图像质量。例如，在不同地点、时间和照明光源(包括车载LED光源、室内白炽灯和自然光)的环境中，车载摄像机采集的导引路径图像呈现不同的效果。而图像按照光照不均匀可以分为两类：一类是因光照不足出现的图像局部亮度值低，细节模糊无法辨认。一类是物体表面发生反光，出现高光现象，导致图像原始信息丢失且难以提取。复杂光照条件就是指由高亮光与暗阴影的随机出现而导致的图像照度及其区域分布的不规则动态变化。随着不同地点、不同时刻的复杂光照动态变化，地面背景与导引路径的颜色特征发生显著变化，路径识别算法的精确性和可靠性受到很大影响。为了保证视觉导引系统的性能稳定性，有必要对复杂光照条件下路径特征提取问题进行深入研究。
在路径导引参数测量方面，目前常用的方法包括Hough变换法、最小均方差法、最小二乘法以及基于曲率角估计的拟合法，这些方法在理想光照环境下的导引精度较高，然而路径识别精度对图像分割错误点较敏感，无法保证复杂光照条件下视觉导引的精确性与可靠性。
发明内容
针对于上述现有技术的不足，本发明的目的在于提供一种复杂光照条件下视觉导引系统的路径提取与识别方法，以解决现有技术中导引路径参数测量的方法，在理想光照环境下的导引精度较高，但无法保证复杂光照条件下视觉导引的精确性与可靠性的问题。
为达到上述目的，本发明采用的技术方案如下：
本发明的一种复杂光照条件下视觉导引系统的路径提取与识别方法，包括步骤如下：
1)采集给视觉导引系统识别导引路径提供光照条件的照明光源以及造成光线遮挡的环境物体所共同形成的N幅复杂光照路径图像，包括N1幅具有高亮光区域的路径图像、N2幅具有暗阴影区域的路径图像和N3幅同时具有高亮光和暗阴影区域的路径图像；
2)针对N幅复杂光照路径图像，通过摄像机成像原理统计复杂光照路径图像中同一像素点的光照照度与图像亮度分量的对应关系，以图像亮度分量代替光照照度，建立表征复杂光照下路径图像色彩分布规律的光照色彩模型，描述复杂光照路径图像的色度分量相对于亮度分量的变化情况；
3)以采集的N幅复杂光照路径图像为样本图像，采用机器学习方法，设计一种区分复杂光照路径图像中高亮光区域、正常照度区域和暗阴影区域的图像照度分类器，并利用所述图像照度分类器区分复杂光照路径图像中的不同照度区域；
4)针对复杂光照路径图像的暗阴影区域，将图像从YCbCr色彩空间转换到RGB色彩空间，根据光照色彩模型选取标准照度所对应的图像亮度值并进行图像增强，再将增强后的图像转换回YCbCr色彩空间；再采用最大类间方差的阈值分割方法，以蓝色色度分量Cb为分割条件，从图像背景区域中提取目标路径像素集P1；
5)针对复杂光照路径图像的高亮光区域，根据光照色彩模型对蓝色色度分量Cb与红色色度分量Cr进行差分运算，从而获得表征图像Cb-Cr色度差分值相对于图像照度变化规律的光照差分色度模型；再采用最大类间方差的阈值分割方法，以Cb-Cr色度差分值为分割条件，从图像背景区域中提取目标路径像素集P2；
6)针对复杂光照路径图像的正常照度区域，采用固定单阈值分割方法，以蓝色色度分量Cb为分割条件，从图像背景区域中提取目标路径像素集P3；
7)针对分别从复杂光照路径图像的暗阴影区域、高亮光区域和正常照度区域所提取的所有目标路径像素集P，采用粒子群优化方法，识别像素集P所表示的导引路径的最优参数模型，并根据最优参数模型计算路径偏差。
优选地，所述的步骤1)中复杂光照路径图像的采集方法如下：以地面铺设的导引路径为视觉导引系统的识别目标，在移动机器人的运行过程中，针对其车载照明光源、室内环境灯光、室外射入的自然光以及遮挡光源光线的环境物体，采集由于光源亮度变化、多个光源和环境物体相对于移动机器人的位置角度变化和空间分布变化而形成的具有高亮光或和暗阴影区域、明暗对比强烈、照度分布很不均匀的N幅复杂光照路径图像。
优选地，所述的步骤的2)中光照色彩模型的建立方法如下：根据摄像机成像原理，分析出光照照度与图像亮度分量成线性相关，并通过实验验证：通过移动机器人的车载摄像机，拍摄不同光照照度条件下的导引路径图像；利用光照照度计测量车载摄像机光心位置处的光照照度E，在复杂光照路径图像中计算对应光心位置处的图像亮度分量Y；针对N幅复杂光照路径图像，统计光心位置处的图像亮度分量Y相对于光照照度E的变化规律；再以图像亮度分量Y代替光照照度E，针对每一幅复杂光照路径图像中的地面背景和目标路径部分，选取光照不均匀区域的像素点，分别统计其蓝色色度分量Cb、红色色度分量Cr与亮度分量Y的相关分布，建立表征复杂光照下路径图像色彩分布规律的光照色彩模型；根据蓝色色度分量Cb与图像亮度分量Y的相关分布，选择暗阴影区域和正常照度区域的初始分区阈值Yb1、正常照度区域和高亮光区域的初始分区阈值Yb2。
优选地，所述的步骤的3)中图像照度分类器的设计方法如下：设暗阴影区域中低照度像素的集合为C1，正常照度区域中正常照度像素的集合为C2，高亮光区域中高照度像素的集合为C3，集合C12为集合C1和C2的并集，集合C23为集合C2和C3的并集；所述图像照度分类器包含第一子分类器和第二子分类器，所述第一子分类器根据其输出值R1将待判断的像素照度分为两类，输出值R1＝1的像素属于C12类，输出值R1＝-1的像素属于C3类；所述第二子分类器根据其输出值R2将待判断的像素照度分为两类，输出值R2＝1的像素属于C23类，输出值R2＝-1的像素属于C1类；当R1＝1且R2＝-1时，待判断的像素属于C1类的低照度像素；当R1＝-1且R2＝1时，待判断的像素属于C3类的高照度像素；当R1＝1且R2＝1时，待判断的像素属于C2类的正常照度像素；当R1＝-1且R2＝-1时，待判断的像素属于不可分像素，若其亮度分量Y小于初始分区阈值Yb1，则该像素属于低照度像素，若其亮度分量Y大于初始分区阈值Yb2，则该像素属于高照度像素，否则该像素属于正常照度像素。
优选地，所述的图像照度分类器的子分类器的设计方法如下：针对路径图像中任一像素p(i,j)，选取其亮度分量Y(i,j)、邻域平均亮度亮度分量与蓝色色度分量Cb(i,j)之比K(i,j)组成该像素p(i,j)的特征向量xi，j，即
其中，i、j为像素在图像平面中的坐标，a为像素p(i,j)的邻域半径，m、n为像素p(i,j)邻域中像素的坐标；
以采集的N幅复杂光照路径图像为样本图像，在特征向量xk所在的多维特征空间中，构建通过机器学习方法训练子分类器的样本集(xk，yk)，其中，k为特征向量xi，j在多维特征空间中的编号，样本集(xk，yk)的总数为l，即k＝1,2,…,l，yk∈{-1，1}，表示样本集中特征向量xk的两类不同分类结果；
在多维特征空间中，若C12类像素与C3类像素线性可分，则第一子分类器采用第一类设计方法，若C12类像素与C3类像素线性不可分，则第一子分类器采用第二类设计方法；若C1类像素与C23类像素线性可分，则第二子分类器采用第一类设计方法，若C1类像素与C23类像素线性不可分，则第二子分类器采用第二类设计方法。
优选地，所述的图像照度分类器的子分类器的第一类设计方法如下：
1)寻找一对最优权值向量w*和最优偏置量b*，构建一个最优分类超平面：
wTxk+b＝0 (4)
使得所有样本点的特征向量xk到最优分类超平面的分类距离dk最大：
2)针对分类距离最大化问题，采用Lagrange乘子α＝[α1，α2，...，αl]T，(αk＞0)进行对偶规划，在给定约束条件下：
求解以下目标函数的最大值：
3)采用二次规划方法求解Lagrange乘子的最优解则最优权值向量w*和最优偏置量b*为：
其中，xr和xs分别为两类像素样本集的特征向量中的任一支持向量；由此可得第一类设计方法的子分类器为：
其中，x为待判断像素的特征向量，T为转置符号，f(x)为子分类器的输出值；对于第一子分类器，R1＝f(x)，对于第二子分类器，R2＝f(x)。
优选地，所述的图像照度分类器的子分类器的第二类设计方法如下：利用核函数对样本进行非线性映射：
H(xm,xn)＝g(xm)g(xn) (11)
则最优权值向量w*为：
由此可得第二类设计方法的子分类器为：
优选地，所述的步骤的4)中暗阴影区域的图像增强方法如下：
1)对暗阴影区域中的低照度像素p(i,j)，将其按下式从YCbCr色彩空间转换到RGB色彩空间：
2)根据实际照度分布与标准照度值的比例关系，利用图像的亮度分量分布Y(i,j)代替图像所对应的实际照度分布，选取对应标准照度值的图像亮度值为Ymid，设I(i,j)为原始图像中像素点p(i,j)的红色分量R、绿色分量G和蓝色分量B中的某一个色彩分量，Iz(i,j)为经过图像增强后像素点p(i,j)的某一相应色彩分量，η为图像增强系数，则根据下式对低照度像素点p(i,j)的色彩分量进行放大增强：
3)对经过图像增强后的像素点p(i,j)，将其按下式从RGB色彩空间转换回YCbCr色彩空间：
优选地，所述的步骤的5)中高亮光区域的光照差分色度模型的建模方法如下：对高亮光区域中的高照度像素点p(i,j)，根据下式计算蓝色色度分量Cb与红色色度分量Cr的Cb-Cr色度差分值：
ΔS(i,j)＝Cb(i,j)-Cr(i,j) (17)
在高亮光区域，统计高照度像素点p(i,j)的Cb-Cr色度差分值ΔS(i,j)与亮度分量Y(i,j)的对应关系，表征Cb-Cr色度差分值相对于照度变化规律的光照差分色度模型。
优选地，所述的步骤的5)中所述最大类间方差的阈值分割方法如下：
对待分割图像，设其包含的像素灰度值范围为{0，1，2，...，l-1}，灰度值为i的像素个数为ni，像素总数为nt，灰度值为i的像素出现的概率为：
利用阈值k将图像分为两类G1＝{0，1，2，..，k}和G2＝{k+1，...，l-1}，利用该阈值，像素被分到G1的概率为：
像素被分到G2的概率为：
至k级的累加均值为：
图像的全局均值为：
类间方差为：
则使得取最大取最大值的k*即为最佳阈值，对输入的待分割图像f(i，j)，采用最佳阈值k*进行图像分割的二值化处理：
优选地，所述的步骤的7)中导引路径参数模型识别的粒子群优化方法如下：
1)按行扫描目标路径像素集P，记录路径左右边界点的像素位置Li1和Li2，根据下式计算第i行路径中点的列坐标：记录该行路径的行坐标：yi＝i，形成目标路径中心点集P0＝{(xi，yi)/i＝1，2，…，n}；
2)设导引路径的参数模型为：
y＝β1x+β0 (26)
目标路径中心点集P0到参数模型的均方差为
根据最小均方差准则对导引路径进行模型识别，采用粒子群优化方法进行非线性模型参数优化，定义式(27)为粒子群的适应度函数；
3)粒子群生成：在h维参数搜索空间，r个粒子组成种群Q＝{q1,q2,…,qr}，即粒子群的规模为r；粒子群中第t个粒子为一个h维向量，即qt＝[Qt1Qt2…Qth]T，表示该粒子在搜索空间中的位置矢量，即参数优化的一个潜在解；第t个粒子的速度矢量为vt＝[Vt1Vt2…Vth]T；
4)粒子群初始化：选取目标路径中心点集P0的首尾两点，即(x1，y1)和(xn，yn)，根据这两点坐标计算路径模型的初始化参数和利用所述参数对粒子群个体进行初始化，并对代间最优个体和种群最优个体进行初始化；根据式(27)计算初始粒子的适应度fint，并利用fint初始化粒子群的个体最优适应度ft s和种群最优适应度fg，即ft s＝fint和fg＝fint；设粒子群的最大进化次数为Nev，初始化粒子群进化代数u＝1；设粒子群进化的速度范围为[Vmin,Vmax]，位置范围为[Qmin,Qmax]；
5)粒子群进化：针对第u(u＝1,2,…,Nev)代粒子群中的r个粒子，根据下式计算最优个体均值：
针对第t个粒子，根据下式计算其第d(d＝1,2,…,h)个分量的惯性权重：
再根据下式计算其第d个分量的加速度因子：
针对第u代的第t个粒子，根据下式计算其第u+1代速度矢量的第d个分量：
其中，λ1和λ2为区间[0,1]中的随机数；若Vtd(u+1)超出速度范围[Vmin,Vmax]，则将其调整到最近的速度边界值；
再根据下式计算其第u+1代位置矢量的第d个分量：
Qtd(u+1)＝Qtd(u)+Vtd(u+1) (32)
若Qtd(u+1)超出位置范围[Qmin,Qmax]，则将其调整到最近的位置边界值；粒子群的进化代数加1，即u＝u+1；
6)粒子群更新：针对第u代粒子群中第t个粒子qt(u)，根据式(27)计算其适应度ft(u)；若第t个粒子第u代适应度优于其个体最优适应度，即则更新第t个粒子的代间最优个体为更新其个体最优适应度为否则不更新第t个粒子的代间最优个体和个体最优适应度；若第t个粒子第u代适应度优于种群最优适应度，即ft(u)<fg，则更新种群最优个体为qg＝qt(u)，更新种群最优适应度为fg＝ft(u)；否则不更新第u代的种群最优个体和种群最优适应度；
7)粒子群迭代：若粒子群的进化代数u>Nev，停止粒子群进化，输出种群最优个体qg，即为目标路径的模型参数；否则转至步骤5)继续粒子群的进化过程；
8)路径偏差计算：在世界坐标系下，利用下式计算移动机器人控制中心C(xc,yc)到路径中心轮廓线的距离偏差为：
其中，Apix为摄像机成像放大倍数；
利用下式计算路径中心轮廓线与移动机器人前进方向的角度偏差为：
其中，β为摄像机安装误差角。
本发明的有益效果：
本发明对复杂光照路径图像采用机器学习方法进行图像照度区域分类，并分别对不同照度区域采取相应预处理，能够精确提取路径特征；采用粒子群优化算法对导引路径模型进行参数优化，识别路径最优模型，精确提取导引参数；在光照环境中同时存在高反光和暗阴影的运行路面，该方法具有较强的复杂光照适应性，提高视觉导引系统在复杂光照环境下的稳定性和准确性。
附图说明
图1为本发明中复杂光照下视觉导引系统的路径提取与识别方法的系统流程图；
图2a为具有高亮光区域的路径图像示意图；
图2b为同时具有高亮光和暗阴影区域的路径图像示意图；
图3为本发明中基于机器学习的路径图像照度区域分类方法流程图；
图4a为具有高亮光区域的路径图像的二值化结果示意图；
图4b为同时具有高亮光和暗阴影区域的路径图像的二值化结果示意图；
图5为本发明中基于粒子群优化算法的路径模型参数寻优流程图；
图6为本发明中路径偏差测量示意图；
图中，线段MN为直线路径中心轮廓线，β为摄像机安装误差、O(0，0)为图像原点坐标、C(xc，yc)为摄像机光心坐标，ed为光心标C(xc，yc)到路径中心轮廓线的距离偏差。
具体实施方式
为了便于本领域技术人员的理解，下面结合实施例与附图对本发明作进一步的说明，实施方式提及的内容并非对本发明的限定。
参照图1所示，本发明中路径提取与识别方法主要包括两个阶段，路径特征提取和导引参数测量。其中路径特征提取包括路径图像照度区域分类、图像分区域预处理、图像分割等步骤；导引参数的测量包括路径中点轮廓信息提取、路径最优参数模型识别及偏差计算。而路径图像照度区域分类又包括离线机器学习和在线实时分类识别。
本发明的复杂光照下视觉导引系统的路径提取与识别方法，具体包括：
1)采集给视觉导引系统识别导引路径提供光照条件的照明光源以及造成光线遮挡的环境物体所共同形成的N幅复杂光照路径图像，包括N1幅具有高亮光区域的路径图像、N2幅具有暗阴影区域的路径图像和N3幅同时具有高亮光和暗阴影区域的路径图像；
2)针对N幅复杂光照路径图像，通过摄像机成像原理统计复杂光照路径图像中同一像素点的光照照度与图像亮度分量的对应关系，以图像亮度分量代替光照照度，建立表征复杂光照下路径图像色彩分布规律的光照色彩模型，描述复杂光照路径图像的色度分量相对于亮度分量的变化情况；
3)以采集的N幅复杂光照路径图像为样本图像，采用机器学习方法，设计一种区分复杂光照路径图像中高亮光区域、正常照度区域和暗阴影区域的图像照度分类器，并利用所述图像照度分类器区分复杂光照路径图像中的不同照度区域；
4)针对复杂光照路径图像的暗阴影区域，将图像从YCbCr色彩空间转换到RGB色彩空间，根据光照色彩模型选取标准照度所对应的图像亮度值并进行图像增强，再将增强后的图像转换回YCbCr色彩空间；再采用最大类间方差的阈值分割方法，以蓝色色度分量Cb为分割条件，从图像背景区域中提取目标路径像素集P1；
5)针对复杂光照路径图像的高亮光区域，根据光照色彩模型对蓝色色度分量Cb与红色色度分量Cr进行差分运算，从而获得表征图像Cb-Cr色度差分值相对于图像照度变化规律的光照差分色度模型；再采用最大类间方差的阈值分割方法，以Cb-Cr色度差分值为分割条件，从图像背景区域中提取目标路径像素集P2；
6)针对复杂光照路径图像的正常照度区域，采用固定单阈值分割方法，以蓝色色度分量Cb为分割条件，从图像背景区域中提取目标路径像素集P3；
7)针对分别从复杂光照路径图像的暗阴影区域、高亮光区域和正常照度区域所提取的所有目标路径像素集P，采用粒子群优化方法，识别像素集P所表示的导引路径的最优参数模型，并根据最优参数模型计算路径偏差。
首先，以地面铺设的导引路径为视觉导引系统的识别目标，在移动机器人的运行过程中，针对其车载照明光源、室内环境灯光、室外射入的自然光等多种光源以及遮挡光源光线的环境物体，采集由于光源亮度变化、多个光源和环境物体相对于移动机器人的位置角度变化和空间分布变化而形成的具有高亮光或和暗阴影区域、明暗对比强烈、照度分布很不均匀的N幅复杂光照路径图像，如图2a，图2b所示。
根据摄像机成像原理，得出光照照度与图像亮度分量成线性相关，并通过实验验证：通过移动机器人的车载摄像机，拍摄不同光照照度条件下的导引路径图像；利用光照照度计测量车载摄像机光心位置处的光照照度E，在复杂光照路径图像中计算对应光心位置处的图像亮度分量Y；针对N幅复杂光照路径图像，统计光心位置处的图像亮度分量Y相对于光照照度E的变化规律。再以图像亮度分量Y代替光照照度E，针对每一幅复杂光照路径图像中的地面背景和目标路径部分，选取光照不均匀区域的像素点，分别统计其蓝色色度分量Cb、红色色度分量Cr与图像亮度分量Y的相关分布，建立表征复杂光照下路径图像色彩分布规律的光照色彩模型；根据光照色彩模型，将路径图像分为暗阴影区域、正常照度区域和高亮光区域；根据蓝色色度分量Cb与亮度分量Y的相关分布，选择暗阴影区域和正常照度区域的初始分区阈值Yb1、正常照度区域和高亮光区域的初始分区阈值Yb2。
然后采用机器学习方法获得图像照度分类的决策模型，具体步骤如下：
1)设置类型及标签。设暗阴影区域中低照度像素的集合为C1，正常照度区域中正常照度像素的集合为C2，高亮光区域中高照度像素的集合为C3，集合C12为集合C1和C2的并集，集合C23为集合C2和C3的并集，分别将C12和C3、C23和C1看作两个2分类问题，构造两个子分类器。
2)构建特征向量。针对路径图像中任一像素p(i,j)，选取其亮度分量Y(i,j)、邻域平均亮度亮度分量与蓝色色度分量之比K(i,j)组成该像素p(i,j)的特征向量xi，j，即
其中，i、j为像素在图像平面中的坐标，a为像素p(i，j)的邻域半径，m、n为像素p(i,j)邻域中像素的坐标。
3)样本离线训练。以采集的N幅复杂光照路径图像为样本图像，在特征向量xk所在的多维特征空间中，构建通过机器学习方法训练子分类器的样本集(xk，yk)，其中，k为特征向量xi，j在多维特征空间中的编号，样本集(xk，yk)的总数为l，即k＝1,2,…,l，yk∈{-1，1}，表示样本集中特征向量xk的两类不同分类结果。经过对两个子分类器的离线训练，得到两个分类决策模型R1、R2。
在多维特征空间中，若C12类像素与C3类像素线性可分，则第一子分类器采用第一类设计方法，若C12类像素与C3类像素线性不可分，则第一子分类器采用第二类设计方法；若C1类像素与C23类像素线性可分，则第二子分类器采用第一类设计方法，若C1类像素与C23类像素线性不可分，则第二子分类器采用第二类设计方法；
所述的图像照度分类器的子分类器的第一类设计方法如下：
1)寻找一对最优权值向量w*和最优偏置量b*，构建一个最优分类超平面：
wTxk+b＝0 (4)
使得所有样本点的特征向量xk到最优分类超平面的分类距离dk最大：
2)针对分类距离最大化问题，采用Lagrange乘子α＝[α1，α2，...，αl]T，(αk＞0)进行对偶规划，在给定约束条件下：
求解以下目标函数的最大值：
3)采用二次规划方法求解Lagrange乘子的最优解则最优权值向量w*和最优偏置量b*为：
其中，xr和xs分别为两类像素样本集的特征向量中的任一支持向量；由此可得第一类设计方法的子分类器为：
其中，x为待判断像素的特征向量，T为转置符号，f(x)为子分类器的输出值；对于第一子分类器，R1＝f(x)，对于第二子分类器，R2＝f(x)；
所述图像照度分类器的子分类器的第二类设计方法如下：利用核函数对样本进行非线性映射：
H(xm,xn)＝g(xm)g(xn) (11)
则最优权值向量w*为：
由此可得第二类设计方法的子分类器为：
如图3所示，本发明所述第一子分类器根据其输出值R1将待判断的像素照度分为两类，输出值R1＝1的像素属于C12类，输出值R1＝-1的像素属于C3类；所述第二子分类器根据其输出值R2将待判断的像素照度分为两类，输出值R2＝1的像素属于C23类，输出值R2＝-1的像素属于C1类；当R1＝1且R2＝-1时，待判断的像素属于C1类的低照度像素；当R1＝-1且R2＝1时，待判断的像素属于C3类的高照度像素；当R1＝1且R2＝1时，待判断的像素属于C2类的正常照度像素；当R1＝-1且R2＝-1时，待判断的像素属于不可分像素，若其亮度分量Y小于初始分区阈值Yb1，则该像素属于低照度像素，若其亮度分量Y大于初始分区阈值Yb2，则该像素属于高照度像素，否则该像素属于正常照度像素。
在通过机器学习离线获得路径图像照度区域分类器后，移动机器人在运行过程中，通过车载摄像机实时采集路径图像，并利用上述机器学习离线训练所得的分类器，对所采集的路径图像实现照度区域分类，然后对不同照度区域分布作相应预处理，具体方法如下：
1)所述暗阴影区域的图像增强步骤如下：
11)对暗阴影区域中的低照度像素p(i,j)，将其按下式从YCbCr色彩空间转换到RGB色彩空间：
12)根据实际照度分布与标准照度值的比例关系，利用图像的亮度分量分布Y(i,j)代替图像所对应的实际照度分布，选取对应标准照度值的图像亮度值为Ymid，设I(i,j)为原始图像中像素点p(i,j)的红色分量R、绿色分量G和蓝色分量B中的某一个色彩分量，Iz(i,j)为经过图像增强后像素点p(i,j)的某一相应色彩分量，η为图像增强系数，则根据下式对低照度像素点p(i,j)的色彩分量进行放大增强：
13)对经过图像增强后的像素点p(i,j)，将其按下式从RGB色彩空间转换回YCbCr色彩空间：
对高亮光区域中的高照度像素点p(i,j)，根据下式计算蓝色色度分量Cb与红色色度分量Cr的Cb-Cr色度差分值：
ΔS(i,j)＝Cb(i,j)-Cr(i,j) (17)
2)在高亮光区域，统计高照度像素点p(i,j)的Cb-Cr色度差分值ΔS(i,j)与亮度分量Y(i,j)的对应关系，表征Cb-Cr色度差分值相对于照度变化规律的光照差分色度模型；
所述最大类间方差的阈值分割方法如下：对待分割图像，设其包含的像素灰度值范围为{0，1，2，...，l-1}，灰度值为i的像素个数为ni，像素总数为，灰度值为i的像素出现的概率为：
利用阈值k将图像分为两类G1＝{0，1，2，...，k}和G2＝{k+1，...，l-1}，利用该阈值，像素被分到G1的概率为：
像素被分到G2的概率为：
至k级的累加均值为：
图像的全局均值为：
类间方差为：
则使得取最大值的k*即为最佳阈值，对输入的待分割图像f(i，j)，采用最佳阈值k*进行图像分割的二值化处理：
图4a为具有高亮光区域的路径图像的二值化结果示意图；图4b为同时具有高亮光和暗阴影区域的路径图像的二值化结果示意图。
导引路径识别的第二阶段为基于粒子群优化算法的导引路径最优参数模型识别设导引路径的参数模型为：
y＝β1x+β0 (26)
目标路径中心点集到参数模型的均方差为：
如图5所示，为求得路径模型的最优参数，利用粒子群优化算法，将式(27)作为目标函数，进行参数寻优，具体步骤如下：
1)按行扫描目标路径像素集P，记录路径左右边界点的像素位置Li1和Li2，根据下式计算第i行路径中点的列坐标：记录该行路径的行坐标：yi＝i，形成目标路径中心点集P0＝{(xi，yi)/i＝1，2，…，n}；
2)根据最小均方差准则对导引路径进行模型识别，采用粒子群优化方法进行非线性模型参数优化，定义式(27)为粒子群的适应度函数；
3)粒子群生成：在h维参数搜索空间，r个粒子组成种群Q＝{q1,q2,…,qr}，即粒子群的规模为r；粒子群中第t个粒子为一个h维向量，即qt＝[Qt1Qt2…Qth]T，表示该粒子在搜索空间中的位置矢量，即参数优化的一个潜在解；第t个粒子的速度矢量为vt＝[Vt1Vt2…Vth]T；
4)粒子群初始化：选取目标路径中心点集P0的首尾两点，即(x1，y1)和(xn，yn)，根据这两点坐标计算路径模型的初始化参数和利用所述参数对粒子群个体进行初始化，并对代间最优个体和种群最优个体进行初始化；根据式(27)计算初始粒子的适应度fint，并利用fint初始化粒子群的个体最优适应度ft s和种群最优适应度fg，即ft s＝fint和fg＝fint；设粒子群的最大进化次数为Nev，初始化粒子群进化代数u＝1；设粒子群进化的速度范围为[Vmin,Vmax]，位置范围为[Qmin,Qmax]；
5)粒子群进化：针对第u(u＝1,2,…,Nev)代粒子群中的r个粒子，根据下式计算最优个体均值：
针对第t个粒子，根据下式计算其第d(d＝1,2,…,h)个分量的惯性权重：
再根据下式计算其第d个分量的加速度因子：
针对第u代的第t个粒子，根据下式计算其第u+1代速度矢量的第d个分量：
其中，λ1和λ2为区间[0,1]中的随机数；若Vtd(u+1)超出速度范围[Vmin,Vmax]，则将其调整到最近的速度边界值；
再根据下式计算其第u+1代位置矢量的第d个分量：
Qtd(u+1)＝Qtd(u)+Vtd(u+1) (32)
若Qtd(u+1)超出位置范围[Qmin,Qmax]，则将其调整到最近的位置边界值；粒子群的进化代数加1，即u＝u+1；
6)粒子群更新：针对第u代粒子群中第t个粒子qt(u)，根据式(27)计算其适应度ft(u)；若第t个粒子第u代适应度优于其个体最优适应度，即则更新第t个粒子的代间最优个体为更新其个体最优适应度为否则不更新第t个粒子的代间最优个体和个体最优适应度；若第t个粒子第u代适应度优于种群最优适应度，即ft(u)<fg，则更新种群最优个体为qg＝qt(u)，更新种群最优适应度为fg＝ft(u)；否则不更新第u代的种群最优个体和种群最优适应度；
7)粒子群迭代：若粒子群的进化代数u>Nev，停止粒子群进化，输出种群最优个体qg，即为目标路径的模型参数；否则转至步骤5)继续粒子群的进化过程。
如图6所示，线段MN表示路径图像中心轮廓线，β为摄像机安装误差、O(0，0)为图像原点坐标、C(xc，yc)为摄像机光心坐标，ed为光心标C(xc，yc)到路径中心轮廓线的距离偏差。
在世界坐标系下，利用式(33)计算移动机器人控制中心C到路径中心轮廓线的距离偏差为：
其中，Apix为摄像机成像放大倍数。
利用式(34)计算路径中心轮廓线与移动机器人前进方向的角度偏差为：
其中，β为摄像机安装误差角。
本发明具体应用途径很多，以上所述仅是本发明的优选实施方式，应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以作出若干改进，这些改进也应视为本发明的保护范围。

Claims (10)

1.一种复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，包括步骤如下：
1)采集给视觉导引系统识别导引路径提供光照条件的照明光源以及造成光线遮挡的环境物体所共同形成的N幅复杂光照路径图像，包括N1幅具有高亮光区域的路径图像、N2幅具有暗阴影区域的路径图像和N3幅同时具有高亮光和暗阴影区域的路径图像；
2)针对N幅复杂光照路径图像，通过摄像机成像原理统计复杂光照路径图像中同一像素点的光照照度与图像亮度分量的对应关系，以图像亮度分量代替光照照度，建立表征复杂光照下路径图像色彩分布规律的光照色彩模型，描述复杂光照路径图像的色度分量相对于亮度分量的变化情况；
3)以采集的N幅复杂光照路径图像为样本图像，采用机器学习方法，设计一种区分复杂光照路径图像中高亮光区域、正常照度区域和暗阴影区域的图像照度分类器，并利用所述图像照度分类器区分复杂光照路径图像中的不同照度区域；
4)针对复杂光照路径图像的暗阴影区域，将图像从YCbCr色彩空间转换到RGB色彩空间，根据光照色彩模型选取标准照度所对应的图像亮度值并进行图像增强，再将增强后的图像转换回YCbCr色彩空间；再采用最大类间方差的阈值分割方法，以蓝色色度分量Cb为分割条件，从图像背景区域中提取目标路径像素集P1；
5)针对复杂光照路径图像的高亮光区域，根据光照色彩模型对蓝色色度分量Cb与红色色度分量Cr进行差分运算，从而获得表征图像Cb-Cr色度差分值相对于图像照度变化规律的光照差分色度模型；再采用最大类间方差的阈值分割方法，以Cb-Cr色度差分值为分割条件，从图像背景区域中提取目标路径像素集P2；
6)针对复杂光照路径图像的正常照度区域，采用固定单阈值分割方法，以蓝色色度分量Cb为分割条件，从图像背景区域中提取目标路径像素集P3；
7)针对分别从复杂光照路径图像的暗阴影区域、高亮光区域和正常照度区域所提取的所有目标路径像素集P，采用粒子群优化方法，识别像素集P所表示的导引路径的最优参数模型，并根据最优参数模型计算路径偏差。
2.根据权利要求1所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的步骤1)中复杂光照路径图像的采集方法如下：以地面铺设的导引路径为视觉导引系统的识别目标，在移动机器人的运行过程中，针对其车载照明光源、室内环境灯光、室外射入的自然光以及遮挡光源光线的环境物体，采集由于光源亮度变化、多个光源和环境物体相对于移动机器人的位置角度变化和空间分布变化而形成的具有高亮光或和暗阴影区域、明暗对比强烈、照度分布很不均匀的N幅复杂光照路径图像。
3.根据权利要求1或2所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的步骤的2)中光照色彩模型的建立方法如下：根据摄像机成像原理，分析出光照照度与图像亮度分量值成线性相关，并通过实验验证：通过移动机器人的车载摄像机，拍摄不同光照照度条件下的导引路径图像；利用光照照度计测量车载摄像机光心位置处的光照照度E，在复杂光照路径图像中计算对应光心位置处的图像亮度分量Y；针对N幅复杂光照路径图像，统计光心位置处的图像亮度分量Y相对于光照照度E的变化规律；再以图像亮度分量Y代替光照照度E，针对每一幅复杂光照路径图像中的地面背景和目标路径部分，选取光照不均匀区域的像素点，分别统计其蓝色色度分量Cb、红色色度分量Cr与亮度分量Y的相关分布，建立表征复杂光照下路径图像色彩分布规律的光照色彩模型；根据蓝色色度分量Cb与图像亮度分量Y的相关分布，选择暗阴影区域和正常照度区域的初始分区阈值Yb1、正常照度区域和高亮光区域的初始分区阈值Yb2。
4.根据权利要求1所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的步骤的3)中图像照度分类器的设计方法如下：设暗阴影区域中低照度像素的集合为C1，正常照度区域中正常照度像素的集合为C2，高亮光区域中高照度像素的集合为C3，集合C12为集合C1和C2的并集，集合C23为集合C2和C3的并集；所述图像照度分类器包含第一子分类器和第二子分类器，所述第一子分类器根据其输出值R1将待判断的像素照度分为两类，输出值R1＝1的像素属于C12类，输出值R1＝-1的像素属于C3类；所述第二子分类器根据其输出值R2将待判断的像素照度分为两类，输出值R2＝1的像素属于C23类，输出值R2＝-1的像素属于C1类；当R1＝1且R2＝-1时，待判断的像素属于C1类的低照度像素；当R1＝-1且R2＝1时，待判断的像素属于C3类的高照度像素；当R1＝1且R2＝1时，待判断的像素属于C2类的正常照度像素；当R1＝-1且R2＝-1时，待判断的像素属于不可分像素，若其亮度分量Y小于初始分区阈值Yb1，则该像素属于低照度像素，若其亮度分量Y大于初始分区阈值Yb2，则该像素属于高照度像素，否则该像素属于正常照度像素。
5.根据权利要求4所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的图像照度分类器的子分类器的设计方法如下：针对路径图像中任一像素p(i,j)，选取其亮度分量Y(i,j)、邻域平均亮度亮度分量与蓝色色度分量Cb(i,j)之比K(i,j)组成该像素p(i,j)的特征向量xi，j，即
<mrow> <mover> <mi>Y</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <mn>2</mn> <mi>a</mi> <mo>+</mo> <mn>1</mn> </mrow> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>n</mi> <mo>=</mo> <mi>i</mi> <mo>-</mo> <mi>a</mi> </mrow> <mrow> <mi>i</mi> <mo>+</mo> <mi>a</mi> </mrow> </munderover> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>m</mi> <mo>=</mo> <mi>j</mi> <mo>-</mo> <mi>a</mi> </mrow> <mrow> <mi>j</mi> <mo>+</mo> <mi>a</mi> </mrow> </munderover> <mi>Y</mi> <mrow> <mo>(</mo> <mi>n</mi> <mo>,</mo> <mi>m</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <mi>K</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <mi>Y</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mi>C</mi> <mi>b</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>x</mi> <mrow> <mi>i</mi> <mo>,</mo> <mi>j</mi> </mrow> </msub> <mo>=</mo> <msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>Y</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mover> <mi>Y</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mi>K</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mi>T</mi> </msup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
其中，i、j为像素在图像平面中的坐标，a为像素p(i,j)的邻域半径，m、n为像素p(i,j)邻域中像素的坐标；
以采集的N幅复杂光照路径图像为样本图像，在特征向量xk所在的多维特征空间中，构建通过机器学习方法训练子分类器的样本集(xk，yk)，其中，k为特征向量xi，j在多维特征空间中的编号，样本集(xk，yk)的总数为l，即k＝1,2,…,l，yk∈{-1，1}，表示样本集中特征向量xk的两类不同分类结果；
在多维特征空间中，若C12类像素与C3类像素线性可分，则第一子分类器采用第一类设计方法，若C12类像素与C3类像素线性不可分，则第一子分类器采用第二类设计方法；若C1类像素与C23类像素线性可分，则第二子分类器采用第一类设计方法，若C1类像素与C23类像素线性不可分，则第二子分类器采用第二类设计方法。
6.根据权利要求5所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的图像照度分类器的子分类器的第一类设计方法如下：
1)寻找一对最优权值向量w*和最优偏置量b*，构建一个最优分类超平面：
wTxk+b＝0 (4)
使得所有样本点的特征向量xk到最优分类超平面的分类距离dk最大：
<mrow> <msub> <mi>d</mi> <mi>k</mi> </msub> <mo>=</mo> <mfrac> <mrow> <mo>|</mo> <mrow> <msup> <mi>w</mi> <mi>T</mi> </msup> <msub> <mi>x</mi> <mi>k</mi> </msub> <mo>+</mo> <mi>b</mi> </mrow> <mo>|</mo> </mrow> <mrow> <mo>|</mo> <mo>|</mo> <mi>w</mi> <mo>|</mo> <mo>|</mo> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
2)针对分类距离最大化问题，采用Lagrange乘子α＝[α1，α2，...，αl]T，(αk＞0)进行对偶规划，在给定约束条件下：
<mrow> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <msub> <mi>&amp;alpha;</mi> <mi>k</mi> </msub> <msub> <mi>y</mi> <mi>k</mi> </msub> <mo>=</mo> <mn>0</mn> <mo>,</mo> <msub> <mi>&amp;alpha;</mi> <mi>k</mi> </msub> <mo>&amp;GreaterEqual;</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
求解以下目标函数的最大值：
<mrow> <mi>max</mi> <mi> </mi> <mi>Q</mi> <mrow> <mo>(</mo> <mi>&amp;alpha;</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <msub> <mi>&amp;alpha;</mi> <mi>k</mi> </msub> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>m</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>n</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>m</mi> </msub> <msub> <mi>&amp;alpha;</mi> <mi>n</mi> </msub> <msub> <mi>y</mi> <mi>m</mi> </msub> <msub> <mi>y</mi> <mi>n</mi> </msub> <mo>)</mo> </mrow> <msubsup> <mi>x</mi> <mi>m</mi> <mi>T</mi> </msubsup> <msub> <mi>x</mi> <mi>n</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>7</mn> <mo>)</mo> </mrow> </mrow>
3)采用二次规划方法求解Lagrange乘子的最优解则最优权值向量w*和最优偏置量b*为：
<mrow> <msup> <mi>w</mi> <mo>*</mo> </msup> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <msubsup> <mi>&amp;alpha;</mi> <mi>k</mi> <mo>*</mo> </msubsup> <msub> <mi>x</mi> <mi>k</mi> </msub> <msub> <mi>y</mi> <mi>k</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <msup> <mi>b</mi> <mo>*</mo> </msup> <mo>=</mo> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>(</mo> <msup> <mi>w</mi> <mo>*</mo> </msup> <mo>)</mo> </mrow> <mi>T</mi> </msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>r</mi> </msub> <mo>+</mo> <msub> <mi>x</mi> <mi>s</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>
其中，xr和xs分别为两类像素样本集的特征向量中的任一支持向量；由此可得第一类设计方法的子分类器为：
<mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <mrow> <mo>(</mo> <msubsup> <mi>&amp;alpha;</mi> <mi>k</mi> <mo>*</mo> </msubsup> <msub> <mi>y</mi> <mi>k</mi> </msub> <mo>)</mo> </mrow> <msup> <mi>x</mi> <mi>T</mi> </msup> <msub> <mi>x</mi> <mi>k</mi> </msub> <mo>+</mo> <msup> <mi>b</mi> <mo>*</mo> </msup> <mo>&gt;</mo> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </mtd> <mtd> <mrow> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <mrow> <mo>(</mo> <msubsup> <mi>&amp;alpha;</mi> <mi>k</mi> <mo>*</mo> </msubsup> <msub> <mi>y</mi> <mi>k</mi> </msub> <mo>)</mo> </mrow> <msup> <mi>x</mi> <mi>T</mi> </msup> <msub> <mi>x</mi> <mi>k</mi> </msub> <mo>+</mo> <msup> <mi>b</mi> <mo>*</mo> </msup> <mo>&lt;</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>10</mn> <mo>)</mo> </mrow> </mrow>
其中，x为待判断像素的特征向量，T为转置符号，f(x)为子分类器的输出值；对于第一子分类器，R1＝f(x)，对于第二子分类器，R2＝f(x)；
其中，所述的图像照度分类器的子分类器的第二类设计方法如下：利用核函数对样本进行非线性映射：
H(xm,xn)＝g(xm)g(xn) (11)
则最优权值向量w*为：
<mrow> <msup> <mi>w</mi> <mo>*</mo> </msup> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <msubsup> <mi>&amp;alpha;</mi> <mi>k</mi> <mo>*</mo> </msubsup> <mi>g</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>k</mi> </msub> <mo>)</mo> </mrow> <msub> <mi>y</mi> <mi>k</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>12</mn> <mo>)</mo> </mrow> </mrow>
由此可得第二类设计方法的子分类器为：
<mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <mrow> <mo>(</mo> <msubsup> <mi>&amp;alpha;</mi> <mi>k</mi> <mo>*</mo> </msubsup> <msub> <mi>y</mi> <mi>k</mi> </msub> <mo>)</mo> </mrow> <mi>H</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <msub> <mi>x</mi> <mi>k</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>b</mi> <mo>*</mo> </msup> <mo>&gt;</mo> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </mtd> <mtd> <mrow> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>k</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>l</mi> </munderover> <mrow> <mo>(</mo> <msubsup> <mi>&amp;alpha;</mi> <mi>k</mi> <mo>*</mo> </msubsup> <msub> <mi>y</mi> <mi>k</mi> </msub> <mo>)</mo> </mrow> <mi>H</mi> <mrow> <mo>(</mo> <mi>x</mi> <mo>,</mo> <msub> <mi>x</mi> <mi>k</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msup> <mi>b</mi> <mo>*</mo> </msup> <mo>&lt;</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>13</mn> <mo>)</mo> </mrow> <mo>.</mo> </mrow>
7.根据权利要求1所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的步骤的4)中暗阴影区域的图像增强方法如下：
1)对暗阴影区域中的低照度像素p(i,j)，将其按下式从YCbCr色彩空间转换到RGB色彩空间：
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>R</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>G</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>B</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfrac> <mn>1</mn> <mn>256</mn> </mfrac> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>298.082</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>408.58</mn> </mtd> </mtr> <mtr> <mtd> <mn>298.082</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mn>100.291</mn> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mn>208.12</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>298.082</mn> </mtd> <mtd> <mn>516.411</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>Y</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>-</mo> <mn>16</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>C</mi> <mi>b</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>-</mo> <mn>128</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>C</mi> <mi>r</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>-</mo> <mn>128</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>14</mn> <mo>)</mo> </mrow> </mrow>
2)根据实际照度分布与标准照度值的比例关系，利用图像的亮度分量分布Y(i,j)代替图像所对应的实际照度分布，选取对应标准照度值的图像亮度值为Ymid，设I(i,j)为原始图像中像素点p(i,j)的红色分量R、绿色分量G和蓝色分量B中的某一个色彩分量，Iz(i,j)为经过图像增强后像素点p(i,j)的某一相应色彩分量，η为图像增强系数，则根据下式对低照度像素点p(i,j)的色彩分量进行放大增强：
<mrow> <msub> <mi>I</mi> <mi>z</mi> </msub> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>I</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <mi>&amp;eta;</mi> <mi>exp</mi> <mrow> <mo>(</mo> <mo>-</mo> <mfrac> <mrow> <mi>Y</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> <msub> <mi>Y</mi> <mrow> <mi>m</mi> <mi>i</mi> <mi>d</mi> </mrow> </msub> </mfrac> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>15</mn> <mo>)</mo> </mrow> </mrow>
3)对经过图像增强后的像素点p(i,j)，将其按下式从RGB色彩空间转换回YCbCr色彩空间：
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>Y</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>C</mi> <mi>b</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>C</mi> <mi>r</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfrac> <mn>1</mn> <mn>256</mn> </mfrac> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>65.738</mn> </mtd> <mtd> <mn>129.057</mn> </mtd> <mtd> <mn>25.06</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mn>37.945</mn> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mn>74.494</mn> </mrow> </mtd> <mtd> <mn>112.43</mn> </mtd> </mtr> <mtr> <mtd> <mn>112.439</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mn>94.154</mn> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mn>18.28</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>R</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>G</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>B</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>16</mn> </mtd> </mtr> <mtr> <mtd> <mn>128</mn> </mtd> </mtr> <mtr> <mtd> <mn>128</mn> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>16</mn> <mo>)</mo> </mrow> <mo>.</mo> </mrow>
8.根据权利要求1所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的步骤的5)中高亮光区域的光照差分色度模型的建模方法如下：对高亮光区域中的高照度像素点p(i,j)，根据下式计算蓝色色度分量Cb与红色色度分量Cr的Cb-Cr色度差分值：
ΔS(i,j)＝Cb(i,j)-Cr(i,j) (17)
在高亮光区域，统计高照度像素点p(i,j)的Cb-Cr色度差分值ΔS(i,j)与亮度分量Y(i,j)的对应关系，表征Cb-Cr色度差分值相对于照度变化规律的光照差分色度模型。
9.根据权利要求1或8所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的步骤的5)中所述最大类间方差的阈值分割方法如下：
对待分割图像，设其包含的像素灰度值范围为{0，1，2，...，l-1}，灰度值为i的像素个数为ni，像素总数为nt，灰度值为i的像素出现的概率为：
<mrow> <msub> <mi>p</mi> <mi>i</mi> </msub> <mo>=</mo> <mfrac> <msub> <mi>n</mi> <mi>i</mi> </msub> <msub> <mi>n</mi> <mi>t</mi> </msub> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>18</mn> <mo>)</mo> </mrow> </mrow>
<mrow> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>l</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <msub> <mi>p</mi> <mi>i</mi> </msub> <mo>=</mo> <mn>1</mn> <mo>,</mo> <msub> <mi>p</mi> <mi>i</mi> </msub> <mo>&gt;</mo> <mn>0</mn> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>19</mn> <mo>)</mo> </mrow> </mrow>
利用阈值k将图像分为两类G1＝{0，1，2，...，k}和G2＝{k+1，...，l-1}，利用该阈值，像素被分到G1的概率为：
<mrow> <msub> <mi>P</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mi>k</mi> </munderover> <msub> <mi>p</mi> <mi>i</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>20</mn> <mo>)</mo> </mrow> </mrow>
像素被分到G2的概率为：
<mrow> <msub> <mi>P</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> </mrow> <mrow> <mi>l</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <msub> <mi>p</mi> <mi>i</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>21</mn> <mo>)</mo> </mrow> </mrow>
至k级的累加均值为：
<mrow> <mi>m</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mi>k</mi> </munderover> <msub> <mi>ip</mi> <mi>i</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>22</mn> <mo>)</mo> </mrow> </mrow>
图像的全局均值为：
<mrow> <msub> <mi>m</mi> <mi>G</mi> </msub> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>0</mn> </mrow> <mrow> <mi>l</mi> <mo>-</mo> <mn>1</mn> </mrow> </munderover> <msub> <mi>ip</mi> <mi>i</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>23</mn> <mo>)</mo> </mrow> </mrow>
类间方差为：
<mrow> <msubsup> <mi>&amp;sigma;</mi> <mi>B</mi> <mn>2</mn> </msubsup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <msup> <mrow> <mo>(</mo> <msub> <mi>m</mi> <mi>G</mi> </msub> <msub> <mi>P</mi> <mn>1</mn> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>-</mo> <mi>m</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mrow> <msub> <mi>P</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <msub> <mi>P</mi> <mn>1</mn> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>24</mn> <mo>)</mo> </mrow> </mrow>
则使得取最大取最大值的k*即为最佳阈值，对输入的待分割图像f(i，j)，采用最佳阈值k*进行图像分割的二值化处理：
<mrow> <mi>g</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>&gt;</mo> <msup> <mi>k</mi> <mo>*</mo> </msup> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>,</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>&amp;le;</mo> <msup> <mi>k</mi> <mo>*</mo> </msup> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>25</mn> <mo>)</mo> </mrow> <mo>.</mo> </mrow>
10.根据权利要求1所述的复杂光照条件下视觉导引系统的路径提取与识别方法，其特征在于，所述的步骤的7)中导引路径参数模型识别的粒子群优化方法如下：
1)按行扫描目标路径像素集P，记录路径左右边界点的像素位置Li1和Li2，根据下式计算第i行路径中点的列坐标：记录该行路径的行坐标：yi＝i，形成目标路径中心点集P0＝{(xi，yi)/i＝1，2，…，n}；
2)设导引路径的参数模型为：
y＝β1x+β0 (26)
目标路径中心点集P0到参数模型的均方差为：
<mrow> <mi>&amp;sigma;</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;beta;</mi> <mn>0</mn> </msub> <mo>,</mo> <msub> <mi>&amp;beta;</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>n</mi> </munderover> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>&amp;beta;</mi> <mn>1</mn> </msub> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>&amp;beta;</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>27</mn> <mo>)</mo> </mrow> </mrow>
根据最小均方差准则对导引路径进行模型识别，采用粒子群优化方法进行非线性模型参数优化，定义式(27)为粒子群的适应度函数；
3)粒子群生成：在h维参数搜索空间，r个粒子组成种群Q＝{q1,q2,…,qr}，即粒子群的规模为r；粒子群中第t个粒子为一个h维向量，即qt＝[Qt1 Qt2 … Qth]T，表示该粒子在搜索空间中的位置矢量，即参数优化的一个潜在解；第t个粒子的速度矢量为vt＝[Vt1 Vt2 …Vth]T；
4)粒子群初始化：选取目标路径中心点集P0的首尾两点，即(x1，y1)和(xn，yn)，根据这两点坐标计算路径模型的初始化参数和利用所述参数对粒子群个体进行初始化，并对代间最优个体和种群最优个进行初始化；根据式(27)计算初始粒子的适应度fint，并利用fint初始化粒子群的个体最优适应度和种群最优适应度fg，即和fg＝fint；设粒子群的最大进化次数为Nev，初始化粒子群进化代数u＝1；设粒子群进化的速度范围为[Vmin,Vmax]，位置范围为[Qmin,Qmax]；
5)粒子群进化：针对第u(u＝1,2,…,Nev)代粒子群中的r个粒子，根据下式计算最优个体均值：
<mrow> <mover> <msubsup> <mi>q</mi> <mi>u</mi> <mi>s</mi> </msubsup> <mo>&amp;OverBar;</mo> </mover> <mo>=</mo> <mfrac> <mn>1</mn> <mi>r</mi> </mfrac> <munderover> <mo>&amp;Sigma;</mo> <mrow> <mi>t</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>r</mi> </munderover> <msubsup> <mi>q</mi> <mi>t</mi> <mi>s</mi> </msubsup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>28</mn> <mo>)</mo> </mrow> </mrow>
针对第t个粒子，根据下式计算其第d(d＝1,2,…,h)个分量的惯性权重：
<mrow> <mi>&amp;omega;</mi> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>1.1</mn> <mo>-</mo> <mfrac> <mrow> <msup> <mi>q</mi> <mi>g</mi> </msup> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mover> <msubsup> <mi>q</mi> <mi>u</mi> <mi>s</mi> </msubsup> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>29</mn> <mo>)</mo> </mrow> </mrow>
再根据下式计算其第d个分量的加速度因子：
<mrow> <msub> <mi>c</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>c</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> <mo>=</mo> <mn>1</mn> <mo>+</mo> <mfrac> <mrow> <msup> <mi>q</mi> <mi>g</mi> </msup> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mover> <msubsup> <mi>q</mi> <mi>u</mi> <mi>s</mi> </msubsup> <mo>&amp;OverBar;</mo> </mover> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>30</mn> <mo>)</mo> </mrow> </mrow>
针对第u代的第t个粒子，根据下式计算其第u+1代速度矢量的第d个分量：
<mrow> <msub> <mi>V</mi> <mrow> <mi>t</mi> <mi>d</mi> </mrow> </msub> <mrow> <mo>(</mo> <mi>u</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <mi>&amp;omega;</mi> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> <msub> <mi>V</mi> <mrow> <mi>t</mi> <mi>d</mi> </mrow> </msub> <mrow> <mo>(</mo> <mi>u</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>c</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> <msub> <mi>&amp;lambda;</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msubsup> <mi>Q</mi> <mrow> <mi>t</mi> <mi>d</mi> </mrow> <mi>s</mi> </msubsup> <mo>(</mo> <mi>u</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>Q</mi> <mrow> <mi>t</mi> <mi>d</mi> </mrow> </msub> <mo>(</mo> <mi>u</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>c</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>d</mi> <mo>)</mo> </mrow> <msub> <mi>&amp;lambda;</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <msubsup> <mi>Q</mi> <mi>d</mi> <mi>g</mi> </msubsup> <mo>(</mo> <mi>u</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>Q</mi> <mrow> <mi>t</mi> <mi>d</mi> </mrow> </msub> <mo>(</mo> <mi>u</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>31</mn> <mo>)</mo> </mrow> </mrow>
其中，λ1和λ2为区间[0,1]中的随机数；若Vtd(u+1)超出速度范围[Vmin,Vmax]，则将其调整到最近的速度边界值；
再根据下式计算其第u+1代位置矢量的第d个分量：
Qtd(u+1)＝Qtd(u)+Vtd(u+1) (32)
若Qtd(u+1)超出位置范围[Qmin,Qmax]，则将其调整到最近的位置边界值；粒子群的进化代数加1，即u＝u+1；
6)粒子群更新：针对第u代粒子群中第t个粒子qt(u)，根据式(27)计算其适应度ft(u)；若第t个粒子第u代适应度优于其个体最优适应度，即则更新第t个粒子的代间最优个体为更新其个体最优适应度为否则不更新第t个粒子的代间最优个体和个体最优适应度；若第t个粒子第u代适应度优于种群最优适应度，即ft(u)<fg，则更新种群最优个体为qg＝qt(u)，更新种群最优适应度为fg＝ft(u)；否则不更新第u代的种群最优个体和种群最优适应度；
7)粒子群迭代：若粒子群的进化代数u>Nev，停止粒子群进化，输出种群最优个体qg，即为目标路径的模型参数；否则转至步骤5)继续粒子群的进化过程；
8)路径偏差计算：在世界坐标系下，利用下式计算移动机器人控制中心C(xc,yc)到路径中心轮廓线的距离偏差为：
<mrow> <msub> <mi>e</mi> <mi>d</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>&amp;beta;</mi> <mn>1</mn> </msub> <msub> <mi>x</mi> <mi>c</mi> </msub> <mo>+</mo> <msub> <mi>&amp;beta;</mi> <mn>0</mn> </msub> <mo>-</mo> <msub> <mi>y</mi> <mi>c</mi> </msub> </mrow> <mrow> <msub> <mi>A</mi> <mrow> <mi>p</mi> <mi>i</mi> <mi>x</mi> </mrow> </msub> <msqrt> <mrow> <mn>1</mn> <mo>+</mo> <msubsup> <mi>&amp;beta;</mi> <mn>1</mn> <mn>2</mn> </msubsup> </mrow> </msqrt> </mrow> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>33</mn> <mo>)</mo> </mrow> </mrow>
其中，Apix为摄像机成像放大倍数；
利用下式计算路径中心轮廓线与移动机器人前进方向的角度偏差为：
<mrow> <msub> <mi>e</mi> <mi>&amp;theta;</mi> </msub> <mo>=</mo> <mi>a</mi> <mi>r</mi> <mi>c</mi> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mfrac> <mn>1</mn> <msub> <mi>&amp;beta;</mi> <mn>1</mn> </msub> </mfrac> <mo>-</mo> <mi>&amp;beta;</mi> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>34</mn> <mo>)</mo> </mrow> </mrow>
其中，β为摄像机安装误差角。
CN201710627847.6A 2017-07-28 2017-07-28 复杂光照条件下视觉导引系统的路径提取与识别方法 Active CN107622502B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710627847.6A CN107622502B (zh) 2017-07-28 2017-07-28 复杂光照条件下视觉导引系统的路径提取与识别方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710627847.6A CN107622502B (zh) 2017-07-28 2017-07-28 复杂光照条件下视觉导引系统的路径提取与识别方法

Publications (2)

Publication Number Publication Date
CN107622502A true CN107622502A (zh) 2018-01-23
CN107622502B CN107622502B (zh) 2020-10-20

Family

ID=61088105

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710627847.6A Active CN107622502B (zh) 2017-07-28 2017-07-28 复杂光照条件下视觉导引系统的路径提取与识别方法

Country Status (1)

Country Link
CN (1) CN107622502B (zh)

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108429589A (zh) * 2018-01-29 2018-08-21 清华大学 光谱分析方法及多节点光谱协同分析方法
CN108845576A (zh) * 2018-06-28 2018-11-20 中国船舶重工集团公司第七0七研究所 一种基于粒子群与序列二次规划结合的推力分配方法
CN109120895A (zh) * 2018-08-24 2019-01-01 浙江大丰实业股份有限公司 安全通道指示灯运行状态验证机构
CN109856133A (zh) * 2019-01-29 2019-06-07 深圳市象形字科技股份有限公司 一种利用多种光照强度、多种色彩照明的试纸检测方法
CN110466419A (zh) * 2018-10-31 2019-11-19 长城汽车股份有限公司 车辆的控制方法、系统及车辆
CN110706237A (zh) * 2019-09-06 2020-01-17 上海衡道医学病理诊断中心有限公司 一种基于YCbCr色彩空间的二氨基联苯胺分离和评估方法
CN110794848A (zh) * 2019-11-27 2020-02-14 北京三快在线科技有限公司 一种无人车控制方法及装置
CN111631637A (zh) * 2020-04-27 2020-09-08 珠海市一微半导体有限公司 视觉机器人确定最佳运动方向和最佳清扫方向的方法
CN111639588A (zh) * 2020-05-28 2020-09-08 深圳壹账通智能科技有限公司 图像效果调整方法、装置、计算机系统及可读存储介质
CN111891390A (zh) * 2020-08-11 2020-11-06 中国科学院微小卫星创新研究院 卫星接口及其连接方法、卫星系统
CN112614181A (zh) * 2020-12-01 2021-04-06 深圳乐动机器人有限公司 一种基于高亮目标的机器人定位方法及装置
CN116958134A (zh) * 2023-09-19 2023-10-27 青岛伟东包装有限公司 基于图像处理的塑料膜挤出质量评估方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101794391A (zh) * 2010-03-18 2010-08-04 中国农业大学 一种温室环境下导航线提取方法
CN102682292A (zh) * 2012-05-10 2012-09-19 清华大学 基于单目视觉的道路边缘检测及粗定位方法
US20160140755A1 (en) * 2014-11-18 2016-05-19 International Business Machines Corporation Image search for a location
CN106097382A (zh) * 2016-05-30 2016-11-09 重庆大学 一种基于区域离散性的隧道场景环境光照干扰抑制方法
CN106709518A (zh) * 2016-12-20 2017-05-24 西南大学 基于Android平台的盲道识别系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101794391A (zh) * 2010-03-18 2010-08-04 中国农业大学 一种温室环境下导航线提取方法
CN102682292A (zh) * 2012-05-10 2012-09-19 清华大学 基于单目视觉的道路边缘检测及粗定位方法
CN102682292B (zh) * 2012-05-10 2014-01-29 清华大学 基于单目视觉的道路边缘检测及粗定位方法
US20160140755A1 (en) * 2014-11-18 2016-05-19 International Business Machines Corporation Image search for a location
CN106097382A (zh) * 2016-05-30 2016-11-09 重庆大学 一种基于区域离散性的隧道场景环境光照干扰抑制方法
CN106709518A (zh) * 2016-12-20 2017-05-24 西南大学 基于Android平台的盲道识别系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
孟庆宽等: "自然光照下基于粒子群算法的农业机械导航路径识别", 《农业机械学报》 *

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108429589A (zh) * 2018-01-29 2018-08-21 清华大学 光谱分析方法及多节点光谱协同分析方法
CN108845576A (zh) * 2018-06-28 2018-11-20 中国船舶重工集团公司第七0七研究所 一种基于粒子群与序列二次规划结合的推力分配方法
CN108845576B (zh) * 2018-06-28 2022-04-12 中国船舶重工集团公司第七0七研究所 一种基于粒子群与序列二次规划结合的推力分配方法
CN109120895B (zh) * 2018-08-24 2020-12-04 浙江大丰实业股份有限公司 安全通道指示灯运行状态验证装置
CN109120895A (zh) * 2018-08-24 2019-01-01 浙江大丰实业股份有限公司 安全通道指示灯运行状态验证机构
CN110466419A (zh) * 2018-10-31 2019-11-19 长城汽车股份有限公司 车辆的控制方法、系统及车辆
CN109856133B (zh) * 2019-01-29 2021-06-22 深圳市象形字科技股份有限公司 一种利用多种光照强度、多种色彩照明的试纸检测方法
CN109856133A (zh) * 2019-01-29 2019-06-07 深圳市象形字科技股份有限公司 一种利用多种光照强度、多种色彩照明的试纸检测方法
CN110706237A (zh) * 2019-09-06 2020-01-17 上海衡道医学病理诊断中心有限公司 一种基于YCbCr色彩空间的二氨基联苯胺分离和评估方法
CN110706237B (zh) * 2019-09-06 2023-06-06 上海衡道医学病理诊断中心有限公司 一种基于YCbCr色彩空间的二氨基联苯胺分离和评估方法
CN110794848A (zh) * 2019-11-27 2020-02-14 北京三快在线科技有限公司 一种无人车控制方法及装置
CN111631637A (zh) * 2020-04-27 2020-09-08 珠海市一微半导体有限公司 视觉机器人确定最佳运动方向和最佳清扫方向的方法
CN111639588A (zh) * 2020-05-28 2020-09-08 深圳壹账通智能科技有限公司 图像效果调整方法、装置、计算机系统及可读存储介质
CN111891390A (zh) * 2020-08-11 2020-11-06 中国科学院微小卫星创新研究院 卫星接口及其连接方法、卫星系统
CN112614181A (zh) * 2020-12-01 2021-04-06 深圳乐动机器人有限公司 一种基于高亮目标的机器人定位方法及装置
CN112614181B (zh) * 2020-12-01 2024-03-22 深圳乐动机器人股份有限公司 一种基于高亮目标的机器人定位方法及装置
CN116958134A (zh) * 2023-09-19 2023-10-27 青岛伟东包装有限公司 基于图像处理的塑料膜挤出质量评估方法
CN116958134B (zh) * 2023-09-19 2023-12-19 青岛伟东包装有限公司 基于图像处理的塑料膜挤出质量评估方法

Also Published As

Publication number Publication date
CN107622502B (zh) 2020-10-20

Similar Documents

Publication Publication Date Title
CN107622502B (zh) 复杂光照条件下视觉导引系统的路径提取与识别方法
CN107729801B (zh) 一种基于多任务深度卷积神经网络的车辆颜色识别系统
Diaz-Cabrera et al. Robust real-time traffic light detection and distance estimation using a single camera
Fleyeh et al. Road and traffic sign detection and recognition
Buluswar et al. Color machine vision for autonomous vehicles
CN112233097B (zh) 基于空时域多维融合的道路场景他车检测系统和方法
Tsai et al. Road sign detection using eigen colour
Verucchi et al. Real-Time clustering and LiDAR-camera fusion on embedded platforms for self-driving cars
CN105678318B (zh) 交通标牌的匹配方法及装置
Wang et al. Shadow detection and removal for illumination consistency on the road
Xiang et al. Moving object detection and shadow removing under changing illumination condition
CN112184765B (zh) 一种用于水下航行器的自主跟踪方法
CN111046789A (zh) 一种行人重识别方法
US20220284703A1 (en) Method and system for automated target recognition
CN110910350A (zh) 一种用于风电塔筒的螺母松动检测方法
Wu et al. Strong shadow removal via patch-based shadow edge detection
Indrabayu et al. Blob modification in counting vehicles using gaussian mixture models under heavy traffic
Fleyeh Traffic and road sign recognition
Kale et al. A road sign detection and the recognition for driver assistance systems
CN111274964B (zh) 一种基于无人机视觉显著性分析水面污染物的检测方法
Chen et al. A novel fire identification algorithm based on improved color segmentation and enhanced feature data
JP2002203240A (ja) 物体認識装置、物体を認識する方法、プログラムおよび記録媒体
CN113033385A (zh) 一种基于深度学习的违章建筑遥感识别方法及系统
CN115100497A (zh) 基于机器人的通道异常物体巡检方法、装置、设备及介质
Lu et al. A cross-scale and illumination invariance-based model for robust object detection in traffic surveillance scenarios

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