WO2014012351A1 - 一种移动机器人的定位***及其定位方法 - Google Patents

一种移动机器人的定位***及其定位方法 Download PDF

Info

Publication number
WO2014012351A1
WO2014012351A1 PCT/CN2013/000822 CN2013000822W WO2014012351A1 WO 2014012351 A1 WO2014012351 A1 WO 2014012351A1 CN 2013000822 W CN2013000822 W CN 2013000822W WO 2014012351 A1 WO2014012351 A1 WO 2014012351A1
Authority
WO
WIPO (PCT)
Prior art keywords
angle
robot
group
central processing
processing unit
Prior art date
Application number
PCT/CN2013/000822
Other languages
English (en)
French (fr)
Inventor
孔钊
宋强
姜飞
Original Assignee
苏州科瓴精密机械科技有限公司
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 苏州科瓴精密机械科技有限公司 filed Critical 苏州科瓴精密机械科技有限公司
Publication of WO2014012351A1 publication Critical patent/WO2014012351A1/zh

Links

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/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0244—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using reflecting strips
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06—Systems determining position data of a target
    • G01S17/42—Simultaneous measurement of distance and other co-ordinates
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06—Systems determining position data of a target
    • G01S17/46—Indirect determination of position data
    • G01S17/48—Active triangulation systems, i.e. using the transmission and reflection of electromagnetic waves other than radio waves
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/16—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using electromagnetic waves other than radio waves

Definitions

  • navigation means that the mobile robot senses the environment and its own state through the sensor, and realizes the target-oriented autonomous movement in an environment with obstacles.
  • the success of navigation requires four modules: perception, positioning, cognition, motion control.
  • positioning is the most basic part of mobile robot navigation.
  • the so-called positioning is to determine the real-time posture of the robot in the environment.
  • the currently used positioning technologies include: visual navigation positioning, global positioning system (GPS), differential GPS positioning, ultrasonic positioning, and so on.
  • GPS global positioning system
  • differential GPS positioning differential GPS positioning
  • ultrasonic positioning and so on.
  • the image processing method of the visual navigation positioning method has a large amount of calculation, and the calculation speed is high, so the real-time performance is poor.
  • the positioning method is greatly affected by the external environment, and thus is not suitable for the positioning system of the outdoor mobile robot.
  • the central processing unit performs arithmetic processing on the first angles to obtain a third angle group between the respective laser reflection lines;
  • Figure 6 is a schematic illustration of the work area of the positioning system of the present invention being rasterized, showing all of the second angles measured when the mobile robot is in any position.

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Electromagnetism (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

一种移动机器人（R）的定位***，包括若干已知反光件、转台（T）、激光器（J）、角度编码器（B）及中央处理单元；所述相邻反光件之间的连线包围形成机器人（R）的工作区域；所述激光器（J）具有发射部（J1）与接收部（J2）；中央处理单元包括对所述工作区域进行栅格化的图形处理程序，中央处理单元计算出每一交叉点连接各个反光件所形成的各条连线（L3）之间的多个第二角度，该多个第二角度组成与每一交叉点对应的第二角度组；所述接收部（J2）可同时接收到从多个反光件反射回来的激光射线（L1），中央处理单元通过运算处理获得各条激光反射线（L1）之间的一个第三角度组，然后将所述第三角度组与所述第二角度组进行对比以获得机器人（R）在所述坐标系内的位置。

Description

一种移动机器人的定位***及其定位方法 技术领域
本发明属于一种机器人的定位技术领域， 尤其涉及一种移动机器人的定位 ***与定位方法。
背景技术
在移动机器人的应用中， 导航是指移动机器人通过传感器感知环境和自身 状态， 实现在有障碍物的环境中面向目标自主运动。 导航的成功需要有四个模 块： 感知， 定位， 认知， 运动控制。 其中， 定位是移动机器人导航最基本的环 节， 所谓定位就是确定机器人在环境中的实时位姿。 当前应用较多的定位技术 有： 视觉导航定位、 全球定位***（GPS, Global Positioning System ), 差分 GPS 定位、 超声波定位等。 其中， 视觉导航定位方式的图像处理计算量大， 计算速 度要求高， 因而实时性差， 此外， 该种定位方式受外界环境的影响较大， 因此 不太适用于户外移动机器人的定位***。 全球定位***是由美国国防部控制的， 对非美国国防部授权的用户， 其所能获得的定位导航精度较低， 因此不适于定 位精度较高的场合。 差分 GPS定位， 是指用户 GPS接收机附近设置一个已知精 度坐标的差分基准站， 基准站的接收机连续接收 GPS导航信号， 将测得的位置 或距离数据与已知的位置、 距离数据进行比较， 确定误差， 得出准确改正值， 然后将这些改正数据通过数据链发播给覆盖区域内的用户， 用以改正用户的定 位结果， 这种定位方法虽然定位精度高， 但成本也很高。 对于超声波定位方式， 由于超声波在空气中衰减很大， 因此只适用空间范围较小的场合。 针对上述各 种定位技术存在的缺陷， 有必要提出一种改进的移动机器人定位***以解决上 述问题。
发明内容
本发明的目的在于提供一种移动机器人通过角度对比来实现定位的定位系 统与定位方法。
为了实现上述目的， 本发明采用如下技术方案： 一种移动机器人的定位系 统， 该定位***设于一坐标系内， 且该定位***包括若干已知坐标值的反光件、 安装于机器人上可 360。旋转的转台、 激光器、 角度编码器及中央处理单元， 所 述激光器与角度编码器安装于所述转台上； 所述相邻反光仵之间的连线包围形 成机器人的工作区域； 所述激光器具有发射部与接收部， 该发射部发出激光发 射线至所述反光件后经反射形成的激光反射线被所述接收部接收， 且所述反光 件具备使该激光反射线平行于激光发射线的光线直反功能； 所述角度编码器用 于测得机器人的机头朝向线与所述激光反射线之间的第一角度； 所述中央处理 单元包括图形处理程序， 该图形处理程序对所述工作区域进行栅格化并得出各 交叉点的坐标值， 中央处理单元计算出每一交叉点连接各个反光件所形成的各 条连接线之间的多个第二角度， 该多个第二角度组成与每一交叉点对应的第二 角度组， 然后将每一第二角度组存储起来； 机器人在所述工作区域内移动时， 所述接收部可同时接收到从多个反光件反射回来的激光反射线， 所述角度编码 器可对应测得多个所述第一角度， 中央处理单元对这些第一角度进行运算处理 以获得各条激光反射线之间的一个第三角度组， 然后将所述第三角度与所述第 二角度进行对比以获得机器人在所述坐标系内的位置。。
优选的， 当所述第三角度组与存储的一个第二角度组中有至少两个连续相 等的角度值时， 机器人的坐标值即为该第二角度组对应的交叉点的坐标值。。
优选的， 当所述第三角度组与存储的任意一个第二角度组中仅有一个相等 的角度值或没有相等的角度值时， 中央处理单元将寻找到与该第三角度组的各 角度值最接近的另一个第二角度组， 机器人在所述坐标系内的位置最接近该另 一个第二角度组所对应的交叉点。
优选的， 所述第二角度为所述各条连接线中相邻两条连接线之间的角度， 所述第三角度为所述各激光反射线中相邻两条激光反射线之间的角度。
优选的， 所述第二角度为其中一条连接线与其他各条连接线之间的角度， 所述第三角度为其中一条激光反射线与其他各条激光反射线之间的角度。
优选的， 所述移动机器人为割草机器人。
优选的， 所述定位***还包括设于机器人上的电子罗盘。
为了实现上述目的， 本发明还可以采用如下技术方案： 一种移动机器人的 定位方法， 该机器人上安装有可 360。旋转的转台、 具有发射部与接收部的激光 器、 角度编码器以及中央处理单元， 所述激光器与角度编码器设于所述转台上， 所述定位方法包括如下步骤： 1 )将多个已知坐标值的反光件设置于机器人所在坐标系内；
2 )所述中央处理单元的图形处理程序对这些反光件的连线包围所形成的工作区 域进行栅格化并得出各交叉点的坐标值；
3 )所述中央处理单元计算出每一交叉点连接各个反光件所形成的各条连接线之 间的多个第二角度， 多个第二角度组成与每一交叉点对应的第二角度组， 然后 将每一第二角度组存储起来；
4 )机器人在所述工作区域内移动时， 所述发射部发出激光发射线至所述反光件 后经反射形成的激光反射线被所述接收部接收， 所述反光件具备使该激光反射 线平行于激光发射线的光线直反功能， 且所述接收部可同时接收到从多个反光 件反射回来的多条激光反射线， 所述角度编码器对应测得机器人的机头朝向线 与所述多条激光反射线之间的多个第一角度；
5 ) 中央处理单元对这些第一角度进行运算处理以获得各条激光反射线之间的一 个第三角度组；
6 ) 中央处理单元将所述第三角度组与所述第二角度组进行对比以获得机器人在 所述坐标系内的位置。
优选的， 当中央处理单元在存储的各个第二角度组中查找到一个第二角度 组， 且该第二角度组与所述第三角度组有至少两个连续相等的角度值时， 中央 处理单元就判断机器人所在位置为该第二角度组所对应的所述交叉点的位置。
优选的， 当中央处理单元未查找到与所述第三角度具有相等角度值的第二 角度组时， 中央处理单元判断机器人所在位置的步骤如下：
1 )将所述第三角度组与存储的每一第二角度组内的各个角度值对应相减， 并得 出数量与第二角度组的数量相等的一系列第四角度组；
2 )将该一系列第四角度组中的各个角度值对应相比并选出具有最小绝对值的第 四角度组；
3 )从选出的第四角度组中选出具有所述最小绝对值最多的第四角度组， 从而获 得与该第四角度组相对应的第二角度组；
4 ) 中央处理单元判断机器人所在位置最靠近步骤 3中的第二角度组所对应的所 述交叉点的位置。
优选的， 当中央处理单元从存储的各个第二角度组中查找到多个第二角度 组， 且该多个第二角度组与所迷第三角度组仅 ^一个相等的周度值时， 中夬处 理单元判断机器人所在位置的步骤如下：
1 )将所述多个第二角度组从存储的各个第二角度组 选出来；
2 )将所述第三角度组与该多个第二角度组内的各个角度值对应相减， 并得出多 个第五角度组；
3 )将该多个第五角度组中的各个角度值对应相比并选出具有最小绝对值的第五 角度组；
4 )从选出的第五角度组中选出具有所述最小绝对值最多的第五角度组， 从而获 得与该第五角度组相对应的第二角度组；
5 )中央处理单元判断机器人所在位置最靠近步骤 4中的第二角度组所对应的所 述交叉点的位置。
优选的， 当机器人按照中央处理单元设定的指定线路移动时， 中央处理单 元按一定频率对所述第二、 第三角度组进行角度对比， 所述机器人按一定速度 沿所述指定线路移动， 中央处理单元判断机器人所在位置的步骤如下：
1 )存储中央处理单元在前一次进行角度对比时机器人在所述坐标系内的前一时 刻位置；
2 )以前一时刻位置为圓心， 所述频率与速度的乘积为半径所形成的圆确定为角 度对比的范围；
3 )选出位于该圓内或圓上的多个交叉点；
4 )将所述第三角度组与该多个交叉点所对应的多个第二角度组对比以获得机器 人在所述坐标系内的位置。
优选的， 机器人上安装有可测得其航行方向的电子罗盘， 中央处理器在所 述多个交叉点中选出位于机器人航行方向上的一部分交叉点， 然后将所述第三 角度组与该一部分交叉点所对应的一部分第二角度组对比以获得机器人所在坐 才示系内的位置。
与现有技术相比， 本发明定位方法通过角度对比来实现机器人定位， 无需 过于复杂的计算程序， 因此不但可实现快速定位， 而且成本低廉。
附图说明
图 1是本发明定位***中移动机器人的部分结构示意图。 图 2是本发明定位***中移动机器人的机头朝向线与激光反射线的示意图， 其中显示了第一角度与第二角度。
图 3 是本发明定位***中工作区域被栅格化后的示意图， 其中显示一交叉 点所对应的所有第三角度。
图 4是本发明定位***中接收部接收多条激光反射线时的示意图， 其中显 示多个第一角度。
图 5是本发明定位***中接收部接收多条激光反射线时的示意图， 其中对 图 4 中的多个第一角度进行运算所得出相邻两条激光反射线之间的多个第二角 度。
图 6是本发明定位***中工作区域被栅格化后的示意图， 其中显示移动机 器人位于任意一位置时所测得的所有第二角度。
图 7是本发明定位***中移动机器人位于任一位置时测得两个连缘的第三 角度时的示意图。
图 8是本发明定位***中工作区域被栅格化后的示意图， 其中移动机器人 沿指定直线移动。
具体实施方式
参图 1与图 2所示， 本发明提供了一种移动机器人定位***， 该定位*** 位于一平面坐标系内， 且包括若干已知坐标值的反光件 M、 安装于该转台 T上 的激光器 J和角度编码器 B以及中央处理单元（未图示）。 在本实施方式中， 所 述移动机器人 R为一割草机器人， 该割草机器人在草坪上工作， 因此整个草坪 为所述坐标系所在平面。 此外， 本实施方式中共设置 10个反光件， 分别为 Ml、 M2... ... M10, 这些反光件为插设于草坪上的具有光线直反功能的杆状路标。
参图 1与图 2所示， 所述转台 T可相对机器人 R机身进行 360。旋转运动， 该转台 T上安装有激光器 J， 该激光器 J具有发射部 J1与接收部 J2。 所述发射 部 J1向外发出激光发射线， 由于转台 T作旋转运动， 因此所述激光器 J也随转 台 T一起进行 360°旋转， 当该激光发射线照射至所述反光件 M上后会被该反光 件反射而形成激光反射线 Ll。 由于所述反光件 M具备光线直反功能， 此处所谓 的光线直反是指反射光与入射光是平行的且两者之间间隔甚小而可被忽略， 因 此所述激光反射线 L1将大致沿所述激光发射线原路返回至机器人 R， 返回的激 无夂射线 L1将衩所迷接收邵 J2接收。
参图 1与图 2所示， 所述转台 T上还设有角度编码器 B, 该角度编码器 B 是用来测得机器人 R的机头朝向线 L2与所述激光反射线 L1之间的第一角度 α, 该第一角度 α的大小是指机器人 R的机头朝向线 L2沿指定方向旋转至所述接收 部 J2接收到所述激光反射线 L1 所转过的角度， 在本实施方式中规定该指定方 向为顺时针方向。 此外， 由于转台 Τ的转速很快， 因此在同一时刻， 发射部 J 1 可同时照射到多个连续的反光件， 接收部 J2则可收到多条激光反射线 L1 , 从而 角度编码器 Β可同时测得多个第一角度 α, 中央处理单元可对多个第一角度 α 进行运算处理并获得相邻两条激光放射线 L1之间的第三角度 β。
参图 1至图 3所示， 本发明还提供一种移动机器人 R的定位方法， 包括如 下步骤：
1 )将多个已知坐标值的反光件 Μ设置于机器人 R所在坐标系内；
2 )所述中央处理单元的图形处理程序对这些反光件 Μ的连线包围所形成的工作 区域进行栅格化并得出各交叉点的坐标值；
3 )所述中央处理单元计算出每一交叉点连接各个反光件 Μ所形成的各条连接线 L3之间的多个第二角度 Θ, 多个第二角度 Θ组成与每一交叉点对应的第二角度 组， 然后将每一第二角度组存储起来；
4 )机器人 R在所述工作区域内移动时， 所述接收部 J2可同时接收到从多个反 光件 Μ反射回来的多条激光反射线 L1 ,所述角度编码器 Β对应测得多个所述第 一角度 α;
5 ) 中央处理单元对这些第一角度 α进行运算处理已获得各条激光反射线 L 1之 间的一个第三角度组；
6 ) 中央处理单元将所述第三角度组与所述第二角度组进行对比以获得机器人在 所述坐标系内的位置。
以下将主要描述如何获得机器人 R在坐标系内的位置的。 图 3中的草坪上 的工作区域已被栅格化， 栅格的边长越小， 精度越高， 因此可以根据需要设定 合适的精度。 工作区域被栅格化的同时可得出各交叉点的坐标值， 现已其中一 个交叉点 Α为例， 由于各反光件的坐标值均已知， 因此相邻两个反光件与交叉 点 A的两条连接线 L3之间的第二角度 Θ可通过计算得出， 本实施方式中共有 ΐυ个反元 1千 Ml、 M2 M10, 因此共有 10个第二角度 θ,、 θ2 θ10, 这 10 个第二角度组成与交叉点 Α对应的一个第二角度组， 从而交叉点 A可以由这一 个第二角度组表示为 Α ( θ,、 θ2...... θ 通过同样的方式可获得其他交叉点所 对应的各个第二角度组。 待程序计算完毕后， 中央处理单元将每一交叉点所对 应的每一个第二角度组置于存储单元内。 以上步骤结束后， 机器人 R开始工作， 结合图 4与图 5所示， 机器人 R在所述工作区域内移动时， 所述激光器 J的发 射部 J1时刻向外发出激光发射线，由于接收部 J2在同一时刻可收到多条激光反 射线 L1 , 在此以接收部 J2可接收到反光件 M1〜M5反射回来的 5条激光放射线 L1为例，此时角度编码器 B可同时获得与之对应的 5个第一角度 01,、 α2、 α3、 α4 α5。所述中央处理单元对这些第一角度进行运算处理可计算出相邻两条激光反射 线 L1之间的四个第三角度， 大小分别为 ο^-α ara2、 α4-α3、 α5-α4。
参图 3与图 6所示， 通过上述分析可知， 当接收部 J2可同时接收到从所有 反光件 Ml、 M2 ··. ..· M10上反射回来的激光反射线 L1时， 中央处理单元则可同 时运算获得与所述交叉点的一组第二角度相对应的 10个第三角度 β,、β2... ... β,ο, 这 10个第三角度组成与机器人 R实时位置相对应的一个第三角度组，从而机器 人 R的实时位置可由所测得的这一个第三角度组表示为 R ( β,、 β2... ... β10 )。 中 央处理单元通过将实时测得的一个第三角度组与存储单元内的第二角度组进行 对比来获得机器人 R当前在坐标系内的位置。
以下具体描述中央处理单元如何将所述第三角度 β与第二角度 Θ对比而获 得机器人 R的当前位置的。当中央处理单元运算获得一个第三角度组 β,、 β2... ... βκι后， 该第三角度组与存储的每个第二角度组相比大致有以下几种情形： 1 )该 第三角度组与存储单元内的一个第二角度组至少有两个连续相等的角度值； 2 ) 该第三角度组与存储单元内的任意一个第二角度组均没有相等的角度值； 3 )该 第三角度组与存储单元内的多个第二角度组只有一个相等的角度值。
对于情形 1， 参图 7所示， 假设测得的第三角度组 β,、 β2... ... 。中的两个 连续的第三角度 β,、 β2与存储单元中一个第二角度组 θ,、 θ2...... θκ)中对应的两 个连续的第二角度 θ,、 θ2相等， 对于已知反光件 Ml、 Μ2、 Μ3的坐标值以及夹 角 β,、 β2的两个三角形 ΔΜ1Μ2Ι 和 A M2M3R, 即可运算得出唯一的机器人所 在点 R的坐标值， 因此在该情形下，机器人 R当前的位置即为该第二角度组 θ,、 ϋ2 Η,ο ^ί^Γ ^的叉又点的位置， 机^人 R当 I 的坐标值即为该交叉点的坐标 值， 而其他角度值互不相等主要是因误差而引起。
对于情形 2, 参图 3与图 6所示， 中央处理器将存储单元中每一个第二角度 组里的角度值与所测得的第三角度组 β,、 β2...... 1()里的角度值对应相减， 以交 叉点 Α为例， 相减后得出一个第四角度组 θ,-β, , θ2-β2...... θκ,-β,ο, 假设共有 η 个交叉点， 则共有 η个第四角度组， 中央处理单元将这 η个第四角度组中的各 个角度值对应相比并选出具有最小绝对值的第四角度组， 从选出的第四角度组 中再选出具有所述最小绝对值最多的第四角度组， 从而获得与该第四角度组'相 对应的第二角度组， 该第二角度组所对应的所述交叉点的位置就是机器人 R在 坐标系内最接近的位置。
对于情形 3, 假设存储单元中共有 m个第二角度组有与所测得的第三角度 组仅有一个相同的角度值， 中央处理单元首先将这 m个第二角度组筛选出来， 然后运用情形 2 中相同的判断方式来确定机器人当前的位置， 即通过角度相减 将得出 m个第五角度组， 中央处理单元将这 m个第五角度组中的各个角度值对 应相比并选出具有最小绝对值的第五角度组， 从选出的第五角度组中再选出具 有所述最小绝对值最多的第五角度组， 从而获得与该第五角度组相对应的第二 角度组， 该第二角度组所对应的所述交叉点的位置就是机器人 R在坐标系内最 接近的位置。 '' 通过对以上 3 中情形的描述可知， 发生情形 1 时， 中央处理单元判断并得 出机器人位置的时间最短； 发生情形 2 时， 由于需要对每一交叉点进行对比， 因此判断时间最长； 情形 3无需对比所有交叉点， 因此判断时间小于情形 2。 在 实际测量过程中， 尤其是栅格精度越小即栅格边长越长时， 发生情形 1 的可能 性就越小， 而发生情形 2和情形 3的可能性最大。 尽管发生情形 2和情形 3的 可能性大， 中央处理单元也无需每次都将测得的第三角度组与所述 n个或 m个 第二角度组进行对比， 因为在通常情况下， 机器人 R是按指定线路移动的， 如 图 8所示， 机器人沿直线 L4移动。 假设机器人移动速度为 0.3米 /秒， 中央处理 器进行角度对比的频率为 1次 /秒， 栅格边长为 0.1米， 机器人 R前一秒的位置 为直线上的 C点， 根据机器人 R的移动速度可以认为机器人 R当前的位置一定 在以 C点为圆心， 0.3米为半径的圓内或圓上， 此时中央处理单元只需将位于该 圓内及圓上的交叉点所对应的若干第二角度组与所测得的第三角度组进行对 比， 对比方法则与以上所描述三种情形相同。 如此， 中央处理单元只需对几个 交叉点进行对比即可， 从而可实现快速定位。 中央处理单元需对比的交叉点还 可以进一步减少， 如增加电子罗盘， 当测得机器人航行方向时， 只需对比在航 行方向上的交叉点， 而未在航行方向上的就无需再作对比了。 真正需要将测得 的第三角度组与所述 n个或 m个第二角度组进行对比的情况仅发生在机器人 R 的前一秒位置未知的情形， 如操作员将机器人 R搬至另一位置， 使其重新开始 工作。
本发明定位***与定位方法通过角度对比来实现机器人定位， 从而无需编 写过于复杂的计算处理程序， 因此具有简化程序和降低成本的功效； 此外， 由 于实际运作过程中， 中央处理单元仅需对比较小范围内的交叉点， 因此可实现 机器人的快速定位。 描述， 本发明定位***与定位方法还有其他实施方式， 如在以上实施方式中所 述的第二角度 Θ为所述各条连接线 L3中相邻两条连接线之间的角度， 所述第三 角度 β为所述各激光反射线 L1中相邻两条激光反射线之间的角度。 第二角度也 可以是其中一条连接线与其他各条连接线之间的角度， 第三角度也可以是其中 一条激光反射线与其他各条激光反射线之间的角度， 角度对比方法相同， 同样 可实现机器人定位。 因此， 只要是在本发明设计理念指导下采用等同或等效变 换方式所获得的技术方案都应在本发明的保护范围之内。

Claims

权 利 要 求 书
1 .一种移动机器人的定位***， 该定位***设于一坐标系内， 且该定位*** 包括若干已知坐标值的反光件、 安装于机器人上可 360。旋转的转台、 激光器、 角度编码器及中央处理单元， 所述激光器与角度编码器安装于所述转台上； 所 述相邻反光件之间的连线包围形成机器人的工作区域； 所述激光器具有发射部 与接收部， 该发射部发出激光发射线至所述反光件后经反射形成的激光反射线 被所述接收部接收， 且所述反光件具备使该激光反射线平行于激光发射线的光 线直反功能； 所述角度编码器用于测得机器人的机头朝向线与所述激光反射线 之间的第一角度； 其特征在于： 所述中央处理单元包括图形处理程序， 该 '图形 处理程序对所述工作区域进行柵格化并得出各交叉点的坐标值， 中央处理单元 计算出每一交叉点连接各个反光件所形成的各条连接线之间的多个第二角度， 该多个第二角度组成与每一交叉点对应的第二角度组， 然后将每一第二角度组 存储起来； 机器人在所述工作区域内移动时， 所述接收部可同时接收到从多个 反光件反射回来的激光反射线， 所述角度编码器可对应测得多个所述第一角度， 中央处理单元对所述多个第一角度进行运算处理以获得各条激光反射线之间的 一个第三角度组， 然后将所述第三角度组与所述第二角度组进行对比以获得机 器人在所述坐标系内的位置。
2.如权利要求 1所述的定位***， 其特征在于： 当所述第三角度组与存储的 一个第二角度组中有至少两个连续相等的角度值时， 机器人的坐标值即为该第 二角度组对应的交叉点的坐标值。
3.如权利要求 2所述的定位***， 其特征在于： 当所述第三角度组与存储的 任意一个第二角度组中仅有一个相等的角度值或没有相等的角度值时， 中央处 理单元将寻找到与该第三角度组的各角度值最接近的另一个第二角度组， 机器 人在所述坐标系内的位置最接近该另一个第二角度组所对应的交叉点。
4.如权利要求 3所述的定位***， 其特征在于： 所述第二角度为所述各条连 接线中相邻两条连接线之间的角度， 所述第三角度为所述各激光反射线中相邻 两条激光反射线之间的角度。
5.如权利要求 3所述的定位***， 其特征在于： 所述第二角度为其中一条连 接线与其他各条连接线之间的角度， 所述第三角度为其中一条激光反射线与其 他务汆激无反射线之 laj的用度。
6.如权利要求 1至 5项中任一项所述的定位***， 其特征在于： 所述移动机 器人为割草机器人。
7.如权利要求 6所述的定位***， 其特征在于： 所述定位***还包括设于机 器人上的电子罗盘。
8.—种移动机器人的定位方法，该机器人上安装有可 360。旋转的转台、具有 发射部与接收部的激光器、 角度编码器以及中央处理单元， 所述激光器与角度 编码器设于所述转台上， 其特征在于： 所述定位方法包括如下步骤：
1 )将多个已知坐标值的反光件设置于机器人所在坐标系内；
2 )所述中央处理单元的图形处理程序对这些反光件的连线包围所形成的工作区 域进行栅格化并得出各交叉点的坐标值；
3 )所述中央处理单元计算出每一交叉点连接各个反光件所形成的各条连接线之 间的多个第二角度， 该多个第二角度组成与每一交叉点对应的第二角度组， 然 后将每一第二角度组存储起来；
4 )机器人在所述工作区域内移动时， 所述发射部发出激光发射线至所述反光件 后经反射形成的激光反射线被所述接收部接收， 所述反光件具备使该激光反射 线平行于激光发射线的光线直反功能， 且所述接收部可同时接收到从多个反光 件反射回来的多条激光反射线， 所述角度编码器对应测得机器人的机头朝向线 与所述多条激光反射线之间的多个第一角度；
5 ) 中央处理单元对所述多个第一角度进行运算处理以获得各条激光反射线之间 的一个第三角度组；
6 ) 中央处理单元将所述第三角度组与所述第二角度组进行对比以获得机器人在 所述坐标系内的位置。
9.如权利要求 8所述的定位方法， 其特征在于： 当中央处理单元在存储的各 个第二角度组中查找到一个第二角度组， 且该第二角度组与所述第三角度组有 至少两个连续相等的角度值时， 中央处理单元就判断机器人所在位置为该第二 角度组所对应的所述交叉点的位置。
10.如权利要求 8所述的定位方法， 其特征在于： 当中央处理单元未查找到 与所述第三角度具有相等角度值的第二角度组时， 中央处理单元判断机器人所 ^:直的 口下：
1 )将所述第三角度组与存储的每一第二角度组内的各个角度值对应相减， 并得 出数量与第二角度组的数量相等的一系列第四角度组；
2 )将该一系列第四角度组中的各个角度值对应相比并选出具有最小绝对值的第 四角度组；
3 )从选出的第四角度组中选出具有所述最小绝对值最多的第四角度组， 从而获 得与该第四角度组相对应的第二角度组；
4 ) 中央处理单元判断机器人所在位置最靠近步骤 3中的第二角度组所对应的所 述交叉点的位置。
1 1 .如权利要求 8所述的定位方法， 其特征在于： 当中央处理单元从存储的 各个第二角度组中查找到多个第二角度组， 且该多个第二角度组与所述第三角 度组仅有 个相等的角度值时， 中央处理单元判断机器人所在位置的步骤如下： 1 )将所述多个第二角度组从存储的各个第二角度组筛选出来；
2 )将所述第三角度组与该多个第二角度组内的各个角度值对应相减， 并得出多 个第五角度组；
3 )将该多个第五角度组中的各个角度值对应相比并选出具有最小绝对值的第五 角度组；
4 )从选出的第五角度组中选出具有所述最小绝对值最多的第五角度组， 从而获 得与该第五角度组相对应的第二角度组；
5 ) 中央处理单元判断机器人所在位置最靠近步驟 4中的第二角度组所对应的所 述交叉点的位置。
12.如权利要求 8所述的定位方法， 其特征在于： 当机器人按照中央处理单 元设定的指定线路移动时， 中央处理单元按一定频率对所述第二、 第三角度组 进行角度对比， 所述机器人按一定速度沿所述指定线路移动， 中央处理单元判 断机器人所在位置的步骤如下：
1 )存储中央处理单元在前一次进行角度对比时机器人在所述坐标系内的前一时 刻位置；
2 ) 以前一时刻位置为圓心， 所述频率与速度的乘积为半径所形成的圆确定为角 度对比的范围； 3 ) 选出位于所述圓内或圓上的多个交叉点；
4 )将所述第三角度组与该多个交叉点所对应的多个第二角度组对比以获得机器 人在所述坐标系内的位置。
13.如权利要求 12所述的定位方法， 其特征在于： 机器人上安装有可测得其 航行方向的电子罗盘， 中央处理器在所述多个交叉点中选出位于机器人航行方 向上的一部分交叉点， 然后将所述第三角度组与该一部分交叉点所对应的一部 分第二角度组对比以获得机器人所在坐标系内的位置。
PCT/CN2013/000822 2012-07-16 2013-07-05 一种移动机器人的定位***及其定位方法 WO2014012351A1 (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201210245557.2 2012-07-16
CN201210245557.2A CN103542846B (zh) 2012-07-16 2012-07-16 一种移动机器人的定位***及其定位方法

Publications (1)

Publication Number Publication Date
WO2014012351A1 true WO2014012351A1 (zh) 2014-01-23

Family

ID=49948217

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2013/000822 WO2014012351A1 (zh) 2012-07-16 2013-07-05 一种移动机器人的定位***及其定位方法

Country Status (2)

Country Link
CN (1) CN103542846B (zh)
WO (1) WO2014012351A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104750115A (zh) * 2015-04-09 2015-07-01 北京科技大学 一种移动设备的激光主动式导航***及导航方法

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104102222B (zh) * 2014-07-31 2017-03-01 广州大学 一种agv精确定位的方法
CN105716619A (zh) * 2016-02-18 2016-06-29 江西洪都航空工业集团有限责任公司 一种基于gps-rtk技术的无人割草车室外导航与控制方法
CN107248171B (zh) * 2017-05-17 2020-07-28 同济大学 一种基于三角剖分的单目视觉里程计尺度恢复方法
CN108020843A (zh) * 2017-12-13 2018-05-11 苏州科瓴精密机械科技有限公司 自动行走设备及自动行走设备定位***
CN108040582A (zh) * 2018-01-26 2018-05-18 武汉理工大学 一种基于dgps的自动循迹电动割草机
CN111367269B (zh) * 2018-12-26 2023-08-15 武汉万集信息技术有限公司 激光雷达的导航定位方法、装置及***
CN109709989A (zh) * 2019-01-09 2019-05-03 中德（珠海）人工智能研究院有限公司 一种定位***、定位方法及增强现实***
CN111745635B (zh) * 2019-03-28 2022-03-04 苏州科瓴精密机械科技有限公司 识别反光标方法、移动机器人定位方法及移动机器人***
CN111812667B (zh) * 2019-04-10 2023-06-06 苏州科瓴精密机械科技有限公司 提高激光转台分辨率的方法及机器人***
CN112212824B (zh) * 2019-07-09 2021-11-26 苏州科瓴精密机械科技有限公司 栅格地图参数的配置方法及配置***
CN112214560A (zh) * 2019-07-09 2021-01-12 苏州科瓴精密机械科技有限公司 栅格地图的更新方法及更新***
CN110543169B (zh) * 2019-08-16 2022-05-24 深圳优地科技有限公司 机器人避障方法、装置、机器人及存储介质
CN112558596A (zh) * 2019-09-06 2021-03-26 苏州科瓴精密机械科技有限公司 自动工作***、自动行走设备及其控制方法及计算机可读存储介质
CN111123287A (zh) * 2019-12-31 2020-05-08 深圳前海达闼云端智能科技有限公司 机器人定位方法、机器人及计算机可读存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5684695A (en) * 1994-03-11 1997-11-04 Siemens Aktiengesellschaft Method and apparatus for constructing an environment map of a self-propelled, mobile unit
CN101456182A (zh) * 2007-12-12 2009-06-17 中国科学院自动化研究所 大型工件焊接智能机器人装置
JP2009223757A (ja) * 2008-03-18 2009-10-01 Toyota Motor Corp 自律移動体、その制御システム、自己位置推定方法
CN102121827A (zh) * 2010-11-29 2011-07-13 浙江亚特电器有限公司 一种移动机器人定位***及其定位方法
CN202928584U (zh) * 2012-07-16 2013-05-08 苏州科瓴精密机械科技有限公司 一种移动机器人的定位***

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2656429B1 (fr) * 1989-12-22 1992-06-12 Commissariat Energie Atomique Procede de determination de la position d'un vehicule.

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5684695A (en) * 1994-03-11 1997-11-04 Siemens Aktiengesellschaft Method and apparatus for constructing an environment map of a self-propelled, mobile unit
CN101456182A (zh) * 2007-12-12 2009-06-17 中国科学院自动化研究所 大型工件焊接智能机器人装置
JP2009223757A (ja) * 2008-03-18 2009-10-01 Toyota Motor Corp 自律移動体、その制御システム、自己位置推定方法
CN102121827A (zh) * 2010-11-29 2011-07-13 浙江亚特电器有限公司 一种移动机器人定位***及其定位方法
CN202928584U (zh) * 2012-07-16 2013-05-08 苏州科瓴精密机械科技有限公司 一种移动机器人的定位***

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104750115A (zh) * 2015-04-09 2015-07-01 北京科技大学 一种移动设备的激光主动式导航***及导航方法

Also Published As

Publication number Publication date
CN103542846A (zh) 2014-01-29
CN103542846B (zh) 2016-12-21

Similar Documents

Publication Publication Date Title
WO2014012351A1 (zh) 一种移动机器人的定位***及其定位方法
CN105157697B (zh) 基于光电扫描的室内移动机器人位姿测量***及测量方法
JP6676814B2 (ja) ライダー強度に基づく物体検出
WO2014012350A1 (zh) 一种移动机器人的定位***及其定位方法
WO2014071834A1 (zh) 一种机器人定位***及其反射装置的识别方法
GB2528024A (en) Automatic measurement of dimensional data with a laser tracker
CN104102222A (zh) 一种agv精确定位的方法
US20230305575A1 (en) Environment boundary construction method based on remote sensor and mobile robot
CN109814093B (zh) 一种基于cpu多核计算的激光雷达仿真方法以及装置
JP2018119852A (ja) 位置特定装置、位置特定方法、位置特定システム、位置特定用プログラム、無人航空機および無人航空機識別用ターゲット
CN108873014A (zh) 一种基于激光雷达的镜面检测方法及装置
CN202928584U (zh) 一种移动机器人的定位***
JPH06229715A (ja) 三次元座標測定装置
Kreczmer Objects localization and differentiation using ultrasonic sensors
GB2510510A (en) Automatic measurement of dimensional data with a laser tracker
CN111488419B (zh) 室内机器人地图的创建方法、装置、电子设备和存储介质
JPS642901B2 (zh)
Kim et al. High resolution mobile robot obstacle detection using low directivity ultrasonic sensor ring
WO2020155142A1 (zh) 一种点云重采样的方法、装置和***
US11928830B2 (en) Systems and methods for generating three-dimensional reconstructions of environments
JPH10332347A (ja) ３次元計測方法及び装置
KR102513036B1 (ko) 3차원 공간 상의 오브젝트를 맵핑하기 위한 평면을 결정하는 방법 및 장치
US11859977B2 (en) Surveying device, surveying method, and surveying program
CN116540273B (zh) Gnss-r镜面反射点初值的位置确定方法、装置及电子设备
CN209877984U (zh) 一种用于养老助残机器人的导航装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 13819697

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

32PN Ep: public notification in the ep bulletin as address of the adressee cannot be established

Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205A DATED 11.06.2015)

122 Ep: pct application non-entry in european phase

Ref document number: 13819697

Country of ref document: EP

Kind code of ref document: A1