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

本发明属于机器人导航技术领域，具体涉及一种剔除点阵式反射标签干扰点方法及机器人导航方法。

背景技术：

机器人在移动时，需要确定自己在地图中的位置以进行路径规划，一种方式是将机器人活动空间的天花板上设置以点形式排列的能够反射红外线或紫外线的反射标签。一种点阵是半方阵，该半方阵至少包含：对角线上至少两端点，以及对角线一侧至少一个点；坐标系的确定方法：坐标系的原点位于垂直于对角线的直线上，该直线与对角线相交于对角线的中点，且原点位于有反射标签的一侧，原点与对角线的两个端点的连线所在的直线分别为x轴和y轴，方向均朝向端点，坐标系满足笛卡尔右手定则。另一种点阵是，对角线两侧都有反射标签的方阵，该方阵至少包含方阵的任意三个端点；坐标系的确定方法：选择该方阵中的三个端点组成坐标系，该三个端点中位于方阵中对角线位置的两个端点分别确定x轴、y轴的方向，另一个端点为坐标系原点，坐标系满足笛卡尔右手定则。机器人通过识别方阵中的反射标签，确定所处空间的坐标系，从而能够确定机器人当下的位置。但是除了反射标签外，其它也会存在反射红外光或紫外光的物质，如果这些能够反射红外光或紫外光的物质刚好位于反射标签附近，则在机器人识别反射标签时，会产生干扰信号，使得机器人定位不准确。

技术实现要素：

本发明是为了解决上述问题而进行的，目的在于提供一种能够过滤干扰点，避免因干扰点的影响而使得机器人坐标定位不准确的剔除点阵式反射标签干扰点方法。

本发明提供了一种剔除点阵式反射标签干扰点方法，其特征在于，包括以下步骤：步骤1，识别所有能够反射不可见光的点，将所有点中任意两点组合，并计算所有组合中两点之间的距离；步骤2，依次选取所有组合作为点阵对角线上的两个端点，并确定各自对应的坐标系；步骤3，将所有组合均根据各组合中两点之间的距离基于预定规则得到点阵中两个标签之间相对于该组合的最小距离，并计算得到除该组合的两点的其余点的在该组合对应的坐标系下的位置坐标；步骤4，对所有组合分别进行如下运算过程后进行标记：判断除了组合中两点的其余点的位置坐标是否是相对于该组合的最小距离的整数倍，并统计位置坐标是相对于该组合的最小距离的整数倍的点的个数，将个数换算为分数标记给该组合；步骤5，选取步骤4中标记分数最高的组合作为真实标签的对角线；步骤6，以步骤5中选取的组合为对角线确定坐标系，剔除位置坐标不是相对于该组合的最小距离的整数倍的点。

进一步，在本发明提供的剔除点阵式反射标签干扰点方法中，还可以具有这样的特征：其中，步骤2中，坐标系的原点位于垂直于对角线的直线上，且直线与对角线相交于对角线的中点，坐标系的x轴和y轴分别与对角线相交于两个端点。

进一步，在本发明提供的剔除点阵式反射标签干扰点方法中，还可以具有这样的特征：其中，不可见光为红外光或紫外光。

进一步，在本发明提供的剔除点阵式反射标签干扰点方法中，还可以具有这样的特征：其中，点阵为N×N方阵、或N×N半方阵、或至少包含有对角线上两点的N×N不完全方阵。

进一步，在本发明提供的剔除点阵式反射标签干扰点方法中，还可以具有这样的特征：其中，步骤3中，两个标签之间的最小距离的计算公式如下：

N≥2

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

本发明还提供了一种机器人导航方法，其特征在于，包含以下步骤:步骤1，机器人采集所有反射标签反射的光线；步骤2，采用前面所述的剔除点阵式反射标签干扰点方法对干扰点进行剔除；步骤3，根据反射标签确定机器人的位置，并进行导航。

本发明的优点如下：

根据本发明所涉及的剔除点阵式反射标签干扰点方法，因为对所有反射光线的点两两测距，并将任意两点均作为对角线，确定坐标系，计算一次该两点作为对角线时，方阵中两点之间的最小距离，然后统计除了作为对角线的两点的其余各点在该坐标系下的位置坐标是最小距离的整数倍的点的个数，并标记该为两点的分数，选择得分最高的两点作为真实标签中的对角线，确定坐标系，然后剔除位置坐标不是相对于该组合的最小距离的整数倍的点，因此，本发明的剔除点阵式反射标签干扰点的方法能够剔除干扰点，避免因干扰点的影响而使得机器人坐标定位不准确。

本发明提供的机器人导航方法，因为采用剔除点阵式反射标签干扰点的方法对干扰点进行剔除，因此机器人定位准确，移动时能够更准确到达指定目标点。

附图说明

图1是本发明中剔除点阵式反射标签干扰点的方法的流程图；

图2是本发明中机器人导航方法的流程图。

具体实施方式

为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解，以下实施例结合附图对本发明剔除点阵式反射标签干扰点方法及机器人导航方法作具体阐述。

剔除点阵式反射标签干扰点方法能够剔除除了反射标签反射的光线形成的光点外其它物质反射光线形成的干扰点，使得机器人能够准确定位。如图1所示，剔除点阵式反射标签干扰点方法包含以下步骤：

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

不可见光为红外光、紫外光等。当反射标签反射红外光时，机器人接收红外光，并识别标签，当反射标签反射紫外光时，机器人接收紫外光，并识别标签。

将识别到的所有点中任意两点组合，即如果识别到M个点，则任意两点之间的组合一共有种组合。

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

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

本专利中，确定坐标系的规则：坐标系的原点位于垂直于对角线的直线上，直线与对角线相交于对角线的中点，坐标系的x轴和y轴分别与对角线相交于两个端点，且x轴和y轴均朝向对角线的两个端点的方向。

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

方阵中两个标签之间的最小距离计算公式如下：

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

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

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

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

一种机器人导航方法，如图2所示，包含以下步骤:

步骤S2-1，机器人采集所有反射标签反射的光线。

步骤S2-2，采用上述剔除点阵式反射标签干扰点方法对干扰点进行剔除。

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

上述实施方式为本发明的优选案例，并不用来限制本发明的保护范围。