剔除点阵式反射标签干扰点方法及机器人导航方法与流程

文档序号:12456782阅读:来源:国知局

技术特征:

1.一种剔除点阵式反射标签干扰点方法,其特征在于,包括以下步骤:

步骤1,识别所有能够反射不可见光的点,将所有点中任意两点组合,并计算所有组合中两点之间的距离;

步骤2,依次选取所有组合作为点阵对角线上的两个端点,并确定各自对应的坐标系;

步骤3,将所有组合均根据各组合中两点之间的距离基于预定规则得到点阵中两个标签之间相对于该组合的最小距离,并计算得到除该组合的两点的其余点的在该组合对应的坐标系下的位置坐标;

步骤4,对所有组合分别进行如下运算过程后进行标记:判断除了组合中两点的其余点的位置坐标中横坐标和纵坐标是否均是相对于该组合的最小距离的整数倍,并统计位置坐标中横坐标和纵坐标是相对于该组合的最小距离的整数倍的点的个数,将个数换算为分数标记给该组合;

步骤5,选取步骤4中标记分数最高的组合作为真实标签的对角线;

步骤6,以步骤5中选取的组合为对角线确定坐标系,剔除位置坐标中横坐标和纵坐标不是相对于该组合的最小距离的整数倍的点。

2.根据权利要求1所述的剔除点阵式反射标签干扰点方法,其特征在于:

步骤2中,所述坐标系的原点位于垂直于对角线的直线上,且所述直线与所述对角线相交于所述对角线的中点,所述坐标系的x轴和y轴分别与所述对角线相交于两个端点。

3.根据权利要求1所述的剔除点阵式反射标签干扰点方法,其特征在于:

所述不可见光为红外光或紫外光。

4.根据权利要求1所述的剔除点阵式反射标签干扰点方法,其特征在于:

所述点阵为N×N方阵、或N×N半方阵、或至少包含有对角线上两点的N×N不完全方阵。

5.根据权利要求1所述的剔除点阵式反射标签干扰点方法,其特征在于:

步骤3中,两个标签之间的最小距离的计算公式如下:

<mrow> <mi>D</mi> <mo>=</mo> <mfrac> <mi>L</mi> <mrow> <msqrt> <mn>2</mn> </msqrt> <mo>&times;</mo> <mrow> <mo>(</mo> <mi>N</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> </mfrac> </mrow>

N≥2

其中,L表示两点之间的距离,D表示标签的最小距离,N表示N×N点阵的行数或列数。

6.一种机器人导航方法,其特征在于,包含以下步骤:

步骤1,机器人采集所有反射标签反射的光线;

步骤2,采用权利要求1~5中任一权利要求所述的剔除点阵式反射标签干扰点方法对干扰点进行剔除;

步骤3,根据反射标签确定机器人的位置,并进行导航。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1