一种移动机器人的定位系统及其定位方法 |
|||||||
| 申请号 | CN201210245558.7 | 申请日 | 2012-07-16 | 公开(公告)号 | CN103542847A | 公开(公告)日 | 2014-01-29 |
| 申请人 | 苏州科瓴精密机械科技有限公司; | 发明人 | 孔钊; 宋强; 姜飞; | ||||
| 摘要 | 一种移动 机器人 的 定位 系统，其包括至少一个已知其坐标值(x1，y1)的反光件(M)、安装于机器人(R)上的转台(T)与 电子 罗盘(P)、安装于所述转台上的激光测距仪(Y)与 角 度 编码器 (B)以及中央处理单元，所述激光测距仪用以获得所述机器人与反光件之间的第一距离(l)，该激光测距仪具有发出发射激光线的发射部(Y1)与接受反射激光线(ML)的接收部(Y2)，所述 电子罗盘 测得机器人机头朝向线与地磁线之间的第一角度(α)，所述角度编码器测得机头朝向线与所述反射激光线之间的第二角度(β)，所述中央处理单元通过运算处理得出机器人当前的坐标值，该定位系统不但定位 精度 高，而且结构简单、成本低廉。 | ||||||
| 权利要求 | 1.一种移动机器人的定位系统，该定位系统设于一坐标系内，其特征在于：该定位系统包括： |
||||||
| 说明书全文 | 一种移动机器人的定位系统及其定位方法技术领域背景技术[0002] 在移动机器人的应用中，导航是指移动机器人通过传感器感知环境和自身状态，实现在有障碍物的环境中面向目标自主运动。导航的成功需要有四个模块：感知，定位，认知，运动控制。其中，定位是移动机器人导航最基本的环节，所谓定位就是确定机器人在环境中的实时位姿。当前应用较多的定位技术有：视觉导航定位、全球定位系统(GPS，Global Positioning System)、差分GPS定位、超声波定位等。其中，视觉导航定位方式的图像处理计算量大，计算速度要求高，因而实时性差，此外，该种定位方式受外界环境的影响较大，因此不太适用于户外移动机器人的定位系统。全球定位系统是由美国国防部控制的，对非美国国防部授权的用户，其所能获得的定位导航精度较低，因此不适于定位精度较高的场合。差分GPS定位，是指用户GPS接收机附近设置一个已知精度坐标的差分基准站，基准站的接收机连续接收GPS导航信号，将测得的位置或距离数据与已知的位置、距离数据进行比较，确定误差，得出准确改正值，然后将这些改正数据通过数据链发播给覆盖区域内的用户，用以改正用户的定位结果，这种定位方法虽然定位精度高，但成本也很高。对于超声波定位方式，由于超声波在空气中衰减很大，因此只适用空间范围较小的场合。针对上述各种定位技术存在的缺陷，有必要提出一种改进的移动机器人定位系统以解决上述问题。 发明内容[0003] 本发明的目的在于提供一种移动机器人定位系统与定位方法，不但定位精度高，而且成本低廉。 [0004] 为了实现上述目的，本发明采用如下技术方案：一种移动机器人的定位系统，该定位系统设于一坐标系内，其特征在于：该定位系统包括： [0005] 已知坐标值的反光件； [0006] 安装于机器人上的转台，该转台可360°旋转； [0007] 安装于所述转台上的激光测距仪，用以获得所述机器人与反光件之间的第一距离，该激光测距仪具有发射部与接收部，该发射部发出激光发射线至所述反光件后经反射形成的激光反射线被所述接收部接收，且所述反光件具备使该激光反射线平行于激光发射线的光线直反功能； [0009] 安装于所述转台上的角度编码器，用于测得机器人的机头朝向线与所述激光反射线之间的第二角度； [0010] 中央处理单元，对所述第一角度、第二角度、第一距离以及反光件的坐标值进行运算处理以获得机器人当前的坐标值，且该坐标值通过以下公式获得：其中α、β分别为所述第一角度与第二角 度，x1、y1为所述反光件的坐标值。 [0011] 优选的，所述定位系统仅设置一个所述反光件。 [0012] 优选的，所述第二角度为机器人自其当前的机头朝向线按相应旋转方向旋转至所述激光反射线所转过的角度。 [0013] 优选的，所述反光件具有使所述激光反射线平行于激光发射线的光线直反功能。 [0014] 优选的，所述机器人为割草机器人。 [0015] 优选的，所述反光件插置于草坪上，该草坪为所述坐标系所在平面。 [0016] 为了实现上述目的，本发明还可以采用如下技术方案：一种移动机器人的定位方法，该机器人上安装有可360°旋转的转台、可实时测得机器人的机头朝向线与地磁方向线之间第一角度的电子罗盘及中央处理单元，所述转台上安装有激光测距仪及角度编码器，所述激光测距仪具有发射部与接受部，所述定位方法包括如下步骤： [0017] 1)将已知其坐标值的反光件设置于机器人所在的坐标系内； [0018] 2)所述激光测距仪的发射部发出激光发射线至所述反光件后经反射形成的激光反射线被所述接收部接收，激光测距仪根据发射部发出激光发射线至接收部受到激光反射线所用的时间获得机器人与所述反光件之间的第一距离； [0019] 3)由所述角度编码器测得机器人机头朝向线与激光反射线之间的第二角度； [0020] 4)由所述中央处理单元对所述第一角度、第二角度、第一距离以及反光件的坐标值进行运算处理以获得机器人当前的坐标值。 [0021] 优选的，所述机器人的坐标值通过以下公式获得： [0022] 其中α、β分别为所述第一角度与第二角度，x1、y1为所述反光件的坐标值。 [0023] 优选的，所述反光件设于所述坐标系的原点位置。 [0024] 优 选 的，所 述 机 器 人 的 坐 标 值 为 (lcos[270 ° -(α+β)]，lsin[270°-(α+β)])。 [0025] 与现有技术相比，本发明定位系统仅设置一个反光件就可以实现割草机器人的实时定位；其次，机器人的坐标公式非常简单，因此简化了中央处理单元的运算程序；此外，本发明定位系统所包含的各部分单元均为现有普通元件，因此成本较低，也就是说本发明定位系统具有定位精度高、结构简单及成本低廉等多个方面的优势。附图说明 [0026] 图1是本发明移动机器人的定位系统的部分结构示意图。 [0027] 图2是本发明移动机器人的定位系统的坐标图。 [0028] 图3是移动机器人在四个象限内定位系统的坐标图。 [0029] 图4是移动机器人的机头朝向改变后在四个象限内定位系统的坐标图。 具体实施方式[0030] 参图1与图2所示，本发明提供了一种移动机器人定位系统，该定位系统位于一平面坐标系内，且包括已知坐标值的反光件M、安装于机器人R上的转台与电子罗盘P、安装于该转台T上的激光测距仪Y与角度编码器B以及用以运算得出机器人实时位置坐标值的中央处理单元(未图示)。在本实施方式中，所述移动机器人R为一割草机器人，该割草机器人在草坪上工作，因此整个草坪为所述坐标系所在平面，所述反光件M为插设于草坪上的路标，该路标为具有光线直反功能的杆状反光件，在本发明中仅设置一个反光件M，且已知其坐标值(x1，y1)。 [0031] 参图1与图2所示，所述转台T相对机器人R机身进行360°旋转运动，该转台T上安装有激光测距Y，该激光测距仪Y具有发射部Y1与接收部Y2。所述发射部Y1向外发出激光发射线，由于转台T作旋转运动，因此所述激光测距仪Y也随转台T一起进行360°旋转，当该激光发射线照射至所述反光件M上后会被该反光件反射而形成激光反射线ML。由于所述反光件M具备光线直反功能，此处所谓的光线直反是指反射光与入射光是平行的且两者之间间隔甚小而可被忽略，因此所述激光反射线ML将大致沿所述激光发射线原路返回至机器人R，返回的激光反射线ML将被所述接收部Y2接收，激光测距仪Y通过发射部Y1发射激光至接收部Y2接收反射激光这一过程所用的时间来获得机器人R至所述反光件M之间的距离，在此称该距离为第一距离l。 [0032] 参图1与图2所示，所述转台T上还设有角度编码器B，该角度编码器B是用来测得机器人R的机头朝向与所述激光反射线ML之间的第二角度β。所述第二角度β的大小是指机器人的机头朝向线沿指定方向旋转至所述接收部Y2接收到所述激光反射线ML所转过的角度，在本实施方式中规定该指定方向为顺时针方向。因此，不管机器人R位于坐标系内的哪个位置，当所述接收部Y2接收到激光反射线ML时，便可同时获得机器人R与反光件M之间的第一距离l及机器人机头朝向与激光反射线ML之间的第二角度β。此外，图2中的角度θ为激光反射线ML与x轴正方向之间的第三角度。 [0033] 参图1与图2所示，机器人上还设有电子罗盘P，该电子罗盘未设置于所述转台T上，它主要用以测得机器人R机头朝向相对于地磁方向之间的第一角度α，该第一角度α的大小为地磁线沿顺时针方向旋转至所述机头朝向线的角度。此外，所述第一角度α与激光是否照射到反光件M没有关联，而只与地磁方向相关，因此电子罗盘P可时刻获得该第一角度α。 [0034] 参图1与图2所示，本发明还提供一种移动机器人的定位方法，包括如下步骤： [0035] 1)将所述已知坐标值(x1，y1)的反光件M插设于坐标系所在草坪平面内； [0036] 2)所述激光测距仪Y的发射部Y1发出激光发射线至所述反光件M后经反射形成的激光反射线ML被所述接收部Y2接收，激光测距仪Y根据发射部Y1发出激光发射线至接收部Y2收到激光反射线ML所用的时间计算得出机器人R与所述反光件M之间的第一距离l； [0037] 3)由所述角度编码器B测得机器人R机头朝向与激光反射线ML之间的第二角度β； [0038] 4)由所述电子罗盘P实时测得机器人的机头朝向与地磁方向之间的第一角度α； [0039] 5)由所述中央处理单元对所述与第一角度α、第二角度β、第一距离l以及反光件M的坐标值(x1，y1)进行运算处理以获得机器人R当前的坐标值(x，y)。 [0040] 以下将主要描述机器人R的坐标值(x，y)是如何获得的。如图3与图4所示，在xoy坐标系中，假设y轴的正负方向分别为地磁N极与S极，因此地磁方向为y轴的正方向。为方便计算说明，在本实施方式中，设定原点O为反光件所在位置。R1、R2、R3、R4这四个点的位置为机器人分别位于坐标系的四个象限内的位置，其中每一点上的射线方向为机器人的机头朝向，该射线为机头朝向线；ML1、ML2、ML3、ML4分别对应机器人在所述四个象限内的激光反射线；α1、α2、α3、α4分别对应机器人在所述四个象限内的第一角度α；β1、β2、β3、β4分别对应机器人在所述四个象限内的第二角度β。 [0041] 机器人R1处于第一象限时有两种情形，其中当其机头朝向线未越过所述激光反射线ML1之前时，如图3所示，电子罗盘P所测得的第一角度α1、角度编码器B所测得的第二角度β1以及所述第三角度θ三者之和等于270°，因此θ＝270°-(α1+β1)且180°≤α1+β1≤270°。当机器人R1的机头朝向线越过所述激光反射线ML1时，如图4所示，机器人R1的机头朝向与图3中的机头朝向相反，其机头朝向线已沿顺时针方向转过所述激光反射线ML，此时电子罗盘P所测得的第一角度α1、角度编码器B所测得的第二角度β1以及所述第三角度θ三者之和等于270°+360°，因此θ＝630°-(α1+β1)，且 180°+360°≤α1+β1≤270°+360°，即540°≤α1+β1≤630°，上述分析可得出以下结论，当机器人R1位于第一象限时， [0042] [0043] 同理，机器人R2位于第二象限时， [0044] [0045] 机器人R3位于第三象限时， [0046] [0047] 机器人R4位于第四象限时， [0048] [0049] 根据第三角度在各象限内的计算公式可归纳出第三角度θ总的计算公式： [0050] [0051] 根据第三角度θ以及第一距离l，就可以获得机器人当前位置的坐标值(x，y)， 第三角度θ的计算公式中，由于270°＝630°-360°＝990°-2×360°，因此不管α+β在什么范围，第三角度θ的正弦或者余弦值都相等，从而机器人当前位置的坐标值R(x，y)可以归结为(lcos[270°-(α+β)]+x1，lsin[270°-(α+β)]+y1)，当设定反光件M为坐标原点O时，计算所得机器人的坐标值为R(lcos[270°-(α+β)]，lsin[270°-(α+β)])。 [0052] 本发明移动机器人实现定位的过程如下：机器人R在行走过程中，激光测距仪Y随所述转台T时刻做360°旋转运动，所述发射部Y1时刻向外发出激光，当发出的激光扫到所述反光件M后能即刻反射回来被所述接收部Y2接收，当接收部Y2接收到反射激光后发出信号给中央处理器，中央处理器对测得的第一角度α、第二角度β、第一距离l以及反光件M的坐标值(x1，y1)计算得出机器人R当前所在位置的坐标值(lcos[270°-(α+β)]+x1，lsin[270°-(α+β)]+y1)。 [0053] 本发明定位系统仅设置一个反光件，即草坪上仅需一个路标就可以实现割草机器人的实时定位；其次，机器人的坐标公式非常简单，因此简化了中央处理单元的运算程序；此外，本发明定位系统所包含的各部分单元均为现有普通元件，因此成本较低，也就是说本发明定位系统具有定位精度高、结构简单及成本低廉等多个方面的优势。 [0054] 以上是为便于本领域技术人员更容易理解本发明所进行的最佳实施方式的描述，但是在本发明设计理念指导下采用等同或等效变换方式所获得的技术方案都应在本发明的保护范围之内。 |
||||||
QQ群二维码
意见反馈
意见反馈