一种基于单摄像头的循迹机器人直角转弯检测方法及装置制造方法
【专利摘要】本发明公开了一种基于单摄像头的循迹机器人直角转弯检测方法，包括，将标本图像中的轨迹成像区域横向平均划分m行；在标本图像中所平均划分的m行中选择机器人摄像头近端成像的n个行作为特征行，并计算n个特征行每一行的纵坐标及质心横坐标；根据所计算的n个特征行每一行的纵坐标及质心横坐标拟合目标像素点分界线；根据分界线左右两侧的目标像素点个数判断直角转弯方向。本发明提供一种既可以降低硬件成本，减少信号采集原件的开支，又可以尽量降低算法复杂度实现准确的信息判断，实现机器人拐弯的方法及装置。
【专利说明】
一种基于单摄像头的循迹机器人直角转弯检测方法及装置
【技术领域】
[0001]本发明涉机器人视觉伺服控制领域，尤其涉及一种基于单摄像头的循迹机器人直角转弯检测方法及装置。
【背景技术】
[0002]在移动机器人循迹领域，机器人转弯策略必不可少，本发明基于直角转弯。在实际使用时，主要集中于以下几种方法:(I)基于光纤传感器，通过主控制器在每个控制周期采集两个或两个以上的光纤传感器的状态，来得到机器人此时状态并判断是否进入转弯模式；(2)基于双摄像头的循迹系统，利用两个摄像头传来的不同图像，按照一定的规则进行信息处理，得到移动机器人是否要进入转弯模式。
[0003]对于(I)所述的方法，重点是利用光纤传感器传来的状态量，利用安装在不同侧的传感器传过来的不同的信号量，得到此时轨迹信息，从而来得到机器人下一步的运行状态。其关键点在于传感器信息的获取以及判断此时状态。该方法在沈伟伟的《基于DSP的轮式移动机器人控制系统设计》中描述的较为详细，但是利用光纤传感器对于轨迹的颜色有特殊要求，只有在轨迹为白色且和背景颜色区分明显的场合下才能使用，不适合用于执行复杂任务的移动机器人，同时对于多个光纤传感器，其布局组合直接影响算法的复杂度。
[0004]对于⑵所述的方法，重点是利用摄像头获得图像信息并通过图像处理的方法对图像进行分析比较，提取轨迹信息，控制移动机器人的运行状态。关键点在于两帧图像的处理方法，以及相应的轨迹信息合并得到机器人是否要进入转角状态。利用两个摄像头的信息融合来做判断，有一定程度上的信息冗余，影响系统的实时性，同时，所需成本较高。
[0005]需要提供一种既可以降低硬件成本，减少信号采集原件的开支，又可以尽量降低算法复杂度实现准确的信息判断，实现机器人拐弯。
【发明内容】
[0006]针对以上问题，本发明提供一种基于单摄像头的循迹机器人直角转弯检测方法，包括，
[0007]步骤1，将标本图像中的轨迹成像区域横向平均划分m行；
[0008]步骤2，在标本图像中所平均划分的m行中选择机器人摄像头近端成像的η个行作为特征行，并计算η个特征行每一行的纵坐标及质心横坐标；步骤3，根据所计算的η个特征行每一行的纵坐标及质心横坐标拟合目标像素点分界线；
[0009]步骤4，根据分界线左右两侧的目标像素点个数判断直角转弯方向。
[0010]进一步地，所述特征行的纵坐标，与所划分出的m行的首行纵坐标及末行纵坐标存在线性关系，即，存在整数的特征行比例系数和整数的首行比例系数，且特征行比例系数大于首行比例系数，使得末行纵坐标的值加上首行纵坐标与首行比例系数的乘积，可以得到特征行纵坐标与特征行比例系数的乘积。
[0011]进一步地，所述特征行的质心横坐标的获取方法为，将所属于特征行的像素点的横坐标累加后再除以像素点的个数，得到特征行的质心横坐标。
[0012]进一步地，所述一种基于单摄像头的循迹机器人直角转弯检测方法，还包括，设定分界线左侧目标像素点个数阈值，设定分界线右侧目标像素点个数阈值。
[0013]进一步地，所述一种基于单摄像头的循迹机器人直角转弯检测方法，还包括，
[0014]步骤41，计算特征分界点横坐标与标本图像中心横坐标的差值；
[0015]步骤42，计算步骤41所得到特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值；
[0016]步骤43，左侧目标像素点个数参数乘以步骤42所计算的特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值所得到的乘积，再加上左侧目标像素点个数参数，即得到设定的左侧目标像素点个数阈值。
[0017]步骤44,右侧目标像素点个数参数乘以步骤42所计算的特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值所得到的乘积，再加上右侧目标像素点个数参数，即得到设定的右侧目标像素点个数阈值。
[0018]更进一步地，所述一种基于单摄像头的循迹机器人直角转弯检测方法，还包括，
[0019]设定当分界线左侧目标像素点多于右侧目标像素点时，左侧目标像素点差值阈值；
[0020]设定当分界线右侧目标像素点多于左侧目标像素点时，右侧目标像素点差值阈值。
[0021]进一步地，所述一种基于单摄像头的循迹机器人直角转弯检测方法，还包括，
[0022]当左侧目标像素点个数大于左侧目标像素点个数阈值，且左侧目标像素点个数与右侧目标像素点个数的差值大于左侧目标像素点差值阈值时，则判断结果为机器人应向左转弯；
[0023]当右侧目标像素点个数大于右侧目标像素点个数阈值，且右侧目标像素点个数与左侧目标像素点个数的差值大于右侧目标像素点差值阈值时，则判断结果为机器人应向右转弯；
[0024]否则，则认为判断失误，重新循迹。
[0025]根据本发明的另一方面，还提供一种基于单摄像头的循迹机器人直角转弯检测装置，包括，
[0026]计算模块，用于将标本图像中的轨迹成像区域横向平均划分m行；在标本图像中所平均划分的m行中选择机器人摄像头近端成像的η个行作为特征行，并计算η个特征行每一行的纵坐标及质心横坐标；根据所计算的η个特征行每一行的纵坐标及质心横坐标拟合目标像素点分界线；
[0027]判断模块，用于根据分界线左右两侧的目标像素点个数判断直角转弯方向。
【专利附图】
【附图说明】
[0028]附图用来提供对本发明的进一步理解，并且构成说明书的一部分，与本发明的实施例共同用于解释本发明，并不构成对本发明的限制。在附图中:
[0029]图1是模拟的一张标本图像；
[0030]图2是在标本图像中拟合分界线图像；
[0031]图3是本发明第一实施例基于单摄像头的循迹机器人直角转弯检测方法的流程图；
[0032]图4是基于单摄像头的循迹机器人直角转弯检测装置模块图；
【具体实施方式】
[0033]以下将结合附图及实施例来详细说明本发明的实施方式，借此对本发明如何应用技术手段来解决技术问题，并达成技术效果的实现过程能充分理解并据以实施。需要说明的是，只要不构成冲突，本发明中的各个实施例以及各实施例中的各个特征可以相互结合，所形成的技术方案均在本发明的保护范围之内。
[0034]第一实施例
[0035]附图1是模拟的一张标本图像，在图1中D的方框区域是标本图像的成像区域，横线部分是轨迹的成像区域，机器人是在运动方向的朝向上获取标本图像，以此标本图像为例，标本图像的底部10端为机器人摄像头近端，标本图像的顶部20端为机器人摄像头远端，按照本发明所述的方法，如附图3所示的步骤，
[0036]步骤1，将标本图像中的轨迹成像区域横向平均划分m行；即在标本图像中，从机器人摄像头远端20至机器人摄像头近端10依次划分为等距的m行，且每行的纵坐标依次为 yl，......，ym。
[0037]步骤2，在标本图像中所平均划分的m行中选择机器人摄像头近端成像的η个行作为特征行，并计算η个特征行每一行的纵坐标及质心横坐标；原则上η个特征行的选择要靠近机器人摄像头近端，η的取值小于或等于m。
[0038]如图1所示，Mj为特征行第j行的质点，(xj, yj)为Mj的质心坐标。特征行的纵坐标，与所划分出的m行的首行纵坐标及末行纵坐标存在线性关系，S卩，存在整数的特征行比例系数和整数的首行比例系数，且特征行比例系数大于首行比例系数，使得末行纵坐标的值加上首行纵坐标与首行比例系数的乘积，可以得到特征行纵坐标与特征行比例系数的乘积。该特征行的纵坐标可以由以下公式确定:
[0039]C2*yj = ym+Cl*yl
[0040]即yj = (ym+Cl*yl)/C2
[0041]其中，C2为特征行比例系数，Cl为首行比例系数，Cl，C2的值是实验经验值，在实验中获取。
[0042]Xj为特征行的质心横坐标，将所属于特征行的像素点的横坐标累加后再除以像素点的个数，得到特征行的质心横坐标。
[0044](j = I, 2,..., m)
[0045]步骤3，根据所计算的η个特征行每一行的纵坐标及质心横坐标拟合目标像素点分界线；
[0046]步骤4，根据分界线左右两侧的目标像素点个数判断直角转弯方向。
[0047]如图2所示，L为根据η个特征行的纵坐标及质心横坐标拟合目标像素点分界线，G为标本图像的中线，G直线上每一点的横坐标都为图像中心横坐标Xo，L直线与特征行的交点为特征分界点，图中特征分界点的横坐标用Xs表示，按照图2建立的平面坐标系，Xs >Xo,设左侧目标像素点个数阈值为Tl,右侧目标像素点个数阈值为T2,T1及Τ2的获取方法为:
[0048]步骤41，计算特征分界点横坐标与标本图像中心横坐标的差值(Xs-Xo)；
[0049]步骤42，计算步骤41所得到特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值(Xs-Xo)/Xo ；
[0050]步骤43，设定左侧目标像素点个数参数a乘以步骤42所计算的特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值所得到的乘积a* [ (Xs-Xo) /Xo],再加上左侧目标像素点个数参数，即得到设定的左侧目标像素点个数阈值Tl =a+a*[(Xs-Xo)/Xo]。
[0051]步骤44，设定右侧目标像素点个数参数b乘以步骤42所计算的特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值所得到的乘积b* [ (Xs-Xo) /Xo],再加上右侧目标像素点个数参数，即得到设定的右侧目标像素点个数阈值T2 =b+b*[(Xs-Xo)/Xo]。
[0052]左侧目标像素点个数参数a及右侧目标像素点个数参数b均是实验获取的经验值。
[0053]设定当分界线左侧目标像素点多于右侧目标像素点时，左侧目标像素点差值阈值为M，设定当分界线右侧目标像素点多于左侧目标像素点时，右侧目标像素点差值阈值为N,其中，左侧目标像素点差值阈值M及右侧目标像素点差值阈值N均是实验获取的经验值。
[0054]在移动机器人循迹过程中，直角检测策略一直在运行，实时的对特征行像素进行扫描，得到两侧的左侧的目标像素点个数记为numleft,右侧的目标像素点个数记为numright，通过比较参数的大小就可以完成左右转的判断。
[0055]当左侧目标像素点个数大于左侧目标像素点个数阈值，且左侧目标像素点个数与右侧目标像素点个数的差值大于左侧目标像素点差值阈值时，则判断结果为机器人应向左转弯;
[0056]即，若numleft〉或者 numright〉,且，
[0057]numIef t-numright>M, (Μ 是一个实验值),则左转；
[0058]当右侧目标像素点个数大于右侧目标像素点个数阈值，且右侧目标像素点个数与左侧目标像素点个数的差值大于右侧目标像素点差值阈值时，则判断结果为机器人应向右转弯;
[0059]即，若numleft〉或者 numright〉,且，
[0060]numright-numIef t>N, (N 是一个实验值)，则右转；
[0061]否则，则认为判断失误，重新循迹。
[0062]第二实施例
[0063]图4是基于单摄像头的循迹机器人直角转弯检测装置模块图，下面参照图4对该实施例进行说明。本发明中，主要包括计算模块21和判断模块22。
[0064]计算模块21，用于将标本图像中的轨迹成像区域横向平均划分m行；在标本图像中所平均划分的m行中选择机器人摄像头近端成像的η个行作为特征行，并计算η个特征行的纵坐标及质心横坐标；根据所计算的η个特征行每一行的纵坐标及质心横坐标拟合目标像素点分界线；
[0065]判断模块22，用于根据分界线左右两侧的目标像素点个数判断直角转弯方向。
[0066]本领域的技术人员应该明白，上述的本发明的各模块或各步骤可以用通用的单片机装置来实现，这样，本发明不限制于任何特定的硬件和软件结合。
[0067]虽然本发明所揭露的实施方式如上，但所述的内容只是为了便于理解本发明而采用的实施方式，并非用以限定本发明。任何本发明所属【技术领域】内的技术人员，在不脱离本发明所揭露的精神和范围的前提下，可以在实施的形式上及细节上作任何的修改与变化，但本发明的专利保护范围，仍须以所附的权利要求书所界定的范围为准。
【权利要求】
1.一种基于单摄像头的循迹机器人直角转弯检测方法，其特征在于，包括， 步骤1，将标本图像中的轨迹成像区域横向平均划分m行； 步骤2，在标本图像中所平均划分的m行中选择机器人摄像头近端成像的η个行作为特征行，并计算η个特征行每一行的纵坐标及质心横坐标； 步骤3，根据所计算的η个特征行每一行的纵坐标及质心横坐标拟合目标像素点分界线.步骤4，根据分界线左右两侧的目标像素点个数判断直角转弯方向。
2.根据权利要求1所述的一种基于单摄像头的循迹机器人直角转弯检测方法，其特征在于，特征行的纵坐标，与所划分出的m行的首行纵坐标及末行纵坐标存在线性关系，SP，存在整数的特征行比例系数和整数的首行比例系数，且特征行比例系数大于首行比例系数，使得末行纵坐标的值加上首行纵坐标与首行比例系数的乘积，可以得到特征行纵坐标与特征行比例系数的乘积。
3.根据权利要求2所述的一种基于单摄像头的循迹机器人直角转弯检测方法，其特征在于，所述特征行的质心横坐标的获取方法为，将所属于特征行的像素点的横坐标累加后再除以像素点的个数，得到特征行的质心横坐标。
4.根据权利要求3所述的一种基于单摄像头的循迹机器人直角转弯检测方法，其特征在于，还包括， 设定分界线左侧目标像素点个数阈值，设定分界线右侧目标像素点个数阈值。
5.根据权利要求5所述的一种基于单摄像头的循迹机器人直角转弯检测方法，其特征在于，还包括， 步骤41，计算特征分界点横坐标与标本图像中心横坐标的差值； 步骤42，计算步骤41所得到的特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值； 步骤43，左侧目标像素点个数参数乘以步骤42所计算的特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值所得到的乘积，再加上左侧目标像素点个数参数，即得到设定的左侧目标像素点个数阈值。 步骤44，右侧目标像素点个数参数乘以步骤42所计算的特征分界点横坐标与标本图像中心横坐标的差值与标本图像中心横坐标的比值所得到的乘积，再加上右侧目标像素点个数参数，即得到设定的右侧目标像素点个数阈值。
6.根据权利要求4所述的一种基于单摄像头的循迹机器人直角转弯检测方法，其特征在于，还包括， 设定当分界线左侧目标像素点多于右侧目标像素点时，左侧目标像素点差值阈值； 设定当分界线右侧目标像素点多于左侧目标像素点时，右侧目标像素点差值阈值。
7.根据权利要求6所述的一种基于单摄像头的循迹机器人直角转弯检测方法，其特征在于，还包括， 当左侧目标像素点个数大于左侧目标像素点个数阈值，且左侧目标像素点个数与右侧目标像素点个数的差值大于左侧目标像素点差值阈值时，则判断结果为机器人应向左转弯; 当右侧目标像素点个数大于右侧目标像素点个数阈值，且右侧目标像素点个数与左侧目标像素点个数的差值大于右侧目标像素点差值阈值时，则判断结果为机器人应向右转弯; 否则，则认为判断失误，重新循迹。
8.一种基于单摄像头的循迹机器人直角转弯检测装置，其特征在于，包括， 计算模块，用于将标本图像中的轨迹成像区域横向平均划分m行；在标本图像中所平均划分的m行中选择机器人摄像头近端成像的η个行作为特征行，并计算η个特征行每一行的纵坐标及质心横坐标；根据所计算的η个特征行的纵坐标及质心横坐标拟合目标像素点分界线； 判断模块，用于根据分界线左右两侧的目标像素点个数判断直角转弯方向。
【文档编号】G05D1/02GK104238558SQ201410338501
【公开日】2014年12月24日 申请日期:2014年7月16日 优先权日:2014年7月16日
【发明者】董勤波, 张敬良, 王宝磊, 贾庆伟 申请人:宁波韦尔德斯凯勒智能科技有限公司