专利名称：机器人虚拟边界建立与识别方法及系统的制作方法
技术领域：
本发明涉及机器人虚拟边界技术领域，尤其涉及一种机器人虚拟边界建立与识别方法及系统。
背景技术：
虚拟边界是用于割草机器人避障、割草及行走的一种非物理边界，它通过安装在割草机器人上的传感器探测信标方位，再通过边界构成算法实现工作区域与非工作区域的识别。现有的机器人虚拟边界识别技术大致可以分为两类一种方法是工作前由人工引导机器人行走覆盖整个工作区，并对所有走过的路线进行记录，机器人循着已存储的路线所包围的区域工作或行走。第二种方法是检测只对机器人可视的“虚拟围墙”，即以预先在边界设置标识物作为“虚拟围墙”，机器人通过传感器探测这些边界标志来确定工作区域的边界。对于第一种方法，在专利US6454036、US4694639中采用示教式的导航方法，通过人工控制割草机器人在工作区域内无遗漏的行走一遍，机器人会对所有走过的路线进行记录，然后沿记录的轨迹运动以完成割草任务。对于这种方式，可以使用单独的定位技术确定机器人当前的位置，也可以根据多种传感器的信息融合来组合定位。但对于GPS等绝对定位技术来说存在定位误差大等缺点，而相对定位虽然在短时间内具有很高的定位精度，但长时间的运行必将会累积大量误差，造成定位错误，以至机器人越界造成事故。尽管可以通过两种定位技术相结合的方式来弥补各自的不足，但定位精度和稳定性方面仍有待提高，并且这种方法也将造成系统的复杂性大大增加，为设计、使用与维护带来诸多不便。对于第二种方法，国外的一些专利技术给出了几种思路，在布设实物信标方面，美国专利US5163273、US4919224、W09915941中介绍了与Auto Mower相似的用电缆包围整个工作区域，然后通电，在工作过程中，机器人通过传感器检查电缆所形成的电磁场来获取边界信息的方法；而在专利JP9135606中，所用方法是在草坪边界设置信标，通过割草机器人上携带的光学传感器探测(岳峰.全区域覆盖自主移动机器人无信标边界生成和识别的研究[D].南京理工大学，2003)，进而获取边界信息等。这些方式所共同的优势是割草机器人对边界的识别非常准确，并且用户可以根据自己的需要围成任意形状。且可以将处在区域中的障碍物用电缆围起来，减少避障系统复杂性，对地面环境要求也较低。但这些方式的缺点也是显而易见的，最重要的就是铺设的电缆需要通电，这将会大大降低实用性。而改进的方式则是将电缆换为按照一定距离布设的磁钉，通过机器人所携带的磁场传感器来探测标识物。这种方法具有较强的适应能力，但同样有磁钉脱落的的隐患存在。有鉴于此，有必要提出一种新的机器人虚拟边界建立与识别方法及系统以解决上述问题
发明内容
本发明的目的在于提供一种适用于割草机器人等小型运动装置的虚拟边界建立与识别方法及系统。本发明的一种机器人虚拟边界建立与识别方法，包括:S1、机器人上的脉冲激光扫描探测模块勻速扫描一周；S2、判断是否检测到两个或两个以上的信标，若是，执行步骤S3，若否，返回执行步骤SI ；S3、判断任意信标间的连线是否为虚拟边界，完成虚拟边界的建立；S4、计算机器人与虚拟边界间的距离，判断最短距离是否小于警戒距离，若是，单片机信息处理模块输出控制信号，控制机器人进行回避。作为本发明的进一步改进，所述步骤SI具体为:加电复位时初始化；通过中断O产生所需的频率信号，控制脉冲激光扫描探测模块旋转，覆盖以割草机器人为圆心，测距为半径的圆形区域；通过中断I判断脉冲激光扫描探测模块是否转过一周。作为本发明的进一步改进，所述步骤SI还包括:计算机器人到标杆的距离以及任意标杆相对于机器人之间的夹角。作为本发明的进一步改进，所述步骤S3具体为:以割草机器人当前位置为固定点，获得若干三角形；根据机器人到标杆的距离以及标杆相对于机器人之间的夹角利用三角形余弦定理求的两信标的距离，判断所得距离是否为预设距离，若是，则两信标间的连线为有效虚拟边界，若否，则两信标间的连线为无效虚拟边界。作为本发明的进一步改进，所述“判断所得距离是否为预设距离”具体为:判断两信标间 的距离是否满足_4η σ +I2 ^ m2 ^ 4η σ +I2，其中I为用三角形余弦定理求的两信标的距离，σ为测距的误差量，η为的最大测量距离。作为本发明的进一步改进，所述步骤S4中机器人与虚拟边界间的距离h=X*y*sina/l，其中X和y分别为机器人到信标之间的距离，Q为两信标与机器人的夹角，I为用三角形余弦定理求的两信标的距离，且a= t，ω为脉冲激光扫描探测模块的角速度，t为脉冲激光扫描探测模块转过两信标所用的时间。相应地，一种如权利要求1所述的机器人虚拟边界建立与识别系统，所述系统包括:机器人及分布在真实边界上的若干信标，所述机器人中包括脉冲激光扫描探测模块、单片机信息处理模块以及虚拟边界建立与识别算法模块。作为本发明的进一步改进，所述信标由金属杆以及围设于金属杆上的反光带构成。作为本发明的进一步改进，所述脉冲激光扫描探测模块包括激光发射单元、激光接收单元及激光准直与聚焦单元。本发明的有益效果是:本发明中的机器人虚拟边界建立与识别方法及系统定位精度较高，测量距离较长；由于激光的单色性好，系统抗外界干扰能力强；系统较为简单，成本低，且具有可靠性强、耗能少、重量轻的特点，作为用于割草机器人这样的小型的运动装置的系统非常合适。
图1是本发明机器人虚拟边界建立与识别方法的流程示意图；图2是本发明机器人虚拟边界建立与识别系统的结构示意图；图3是本发明中信标的结构示意图；图4是本发明机器人测距范围示意图；图5是本发明虚拟边界识别原理模型示意图；图6是本发明有效二角形判断的具体不意图；图7是本发明机器人到边界之间距离几何模型示意图；图8是本发明激光测距的原理示意图；图9是本发明信标中全反射棱镜的工作原理图；图10是本发明机器人虚拟边界建立与识别方法的具体流程图。
具体实施例方式以下将结合附图所示的各实施方式对本发明进行详细描述。但这些实施方式并不限制本发明，本领域的普通技术人员根据这些实施方式所做出的结构、方法、或功能上的变换均包含在本发明的保护范围内。参图1所示，本发明的一种机器人虚拟边界建立与识别方法，优选地，所述机器人为割草机器人包括: S1、机器人上的脉冲激光扫描探测模块匀速扫描一周，同时计算机器人到标杆的距离以及任意标杆相对于机器人之间的夹角。；S2、判断是否检测到两个或两个以上的信标，若是，执行步骤S3，若否，返回执行步骤SI ；S3、判断任意信标间的连线是否为虚拟边界，完成虚拟边界的建立具体为:具体为:以割草机器人当前位置为固定点，获得若干三角形；根据机器人到标杆的距离以及标杆相对于机器人之间的夹角利用三角形余弦定理求的两信标的距离，判断所得距离是否为预设距离，若是，则两信标间的连线为有效虚拟边界，若否，则两信标间的连线为无效虚拟边界。其中，“判断所得距离是否为预设距离”具体为:判断两信标间的距离是否满足_4η σ +I2^m2 ( 4η σ +I2，其中I为用三角形余弦定理求的两信标的距离，σ为测距的误差量，η为的最大测量距离；S4、计算机器人与虚拟边界间的距离，判断最短距离是否小于警戒距离，若是，单片机信息处理模块输出控制信号，控制机器人进行回避。其中，机器人与虚拟边界间的距离h=X*y*sina/l，其中X和y分别为机器人到信标之间的距离，Q为两信标与机器人的夹角，I为用三角形余弦定理求的两信标的距离，且a= t，ω为脉冲激光扫描探测模块的角速度，t为脉冲激光扫描探测模块转过两信标所用的时间。进一步地步骤SI具体为:加电复位时初始化；通过中断O产生所需的频率信号，控制脉冲激光扫描探测模块旋转，覆盖以割草机器人为圆心，测距为半径的圆形区域；通过中断I判断脉冲激光扫描探测模块是否转过一周。相应地，参图2所示，一种机器人虚拟边界建立与识别系统，包括:机器人10及分布在真实边界上的若干信标20，机器人10包括脉冲激光扫描探测模块11、单片机信息处理模块12以及虚拟边界建立与识别算法模块13，进一步地，脉冲激光扫描探测模块11包括激光发射单元、激光接收单元及激光准直与聚焦单元；参图3所示，信标20由金属杆21以及围设于金属杆上的反光带22构成，优选地，在本实施方式中反光带22为全反射棱镜。信标20以一定间隔散布在割草机器人工作区域的物理边界上，反光带22宽度由脉冲激光扫描探测模块11的工作高度及工作区域不平度确定，主要目的是满足割草环境中脉冲激光扫描探测模块11发射的激光可以被有效反射。脉冲激光扫描探测模块11安装在割草机器人上，由一旋转机构带动作圆周匀速扫描，当在探头旋转的同一周之中检测到两个或两个以上的信标时，可通过虚拟边界建立与识别算法模块13对所测得的标杆之间的连线是否为有效虚拟边界进行判断。当系统判断出边界位置时，就可以求出割草机器人此时相对于边界的距离，并可经过比较从中找出距离最近的边界，在距离小于警戒距离时，单片机信息处理模块12将输出控制信号，控制割草机器人进行回避，以免割草机器人越界。本实施方式中，虚拟边界即为两根相邻的信标之间的连线所在的直线。机器人上携带的激光探头进行匀速旋转，在调整脉冲激光扫描探测模块的探测距离为合适后，机器人周围将形成一个圆形的可探测区域，参图4所示。该区域的大小可以根据需要进行调整，本优选实施例中选取可探测区域半径为5米。在探测到机器人与信标之间的距离的同时，还需要对所探测到的标杆相对于机器人之间的夹角进行测量和记录，参图5所示，x、y分别为机器人到标杆的距离，α为它们之间的夹角。通过单片机信息处理模块对脉冲激光扫描探测模块检测到的标杆转过的时间进行测量，在探头匀速旋转的条件下，标杆之间相对于机器人的夹角即可得到。这样就可以建立起一个三角形模型， 得到需要的距离和角度参数。割草机器人通过探测在草坪边界所设置的信标，当检测到两个或两个以上的信标时，机器人将与信标之间建立三角形，通过机器人上配备的单片机信息处理模块和脉冲激光扫描探测模块获得机器人与标杆之间的距离和角度信息，根据建立的模型计算与虚拟边界间的距离。参图6所示，尽量让相邻的信标杆之间的距离保持一致，理论推导时设为一个固定的常数I。当启动机器人工作时，测距系统开始运行，探测即开始，并把此点作为参考基点。当激光探头在旋转一周的过程中(相对于参考基点)，如果割草机器人检测到两个或两个以上的标杆之时，以割草机器人当前位置为固定点，可获得若干三角形。若检测到的标杆数量为a (a>l),可知此时建立三角形数量b为:
r n , aia — I)b =—--
2 ,而在这些三角形之中，只有机器人与相邻的标杆之间建立的三角形才是实际与虚拟边界相关的三角形，对应的两信标之间的连线才为实际的虚拟边界，称这些为有效三角形。有效三角形通过判断检测到的信标之间的距离来确定。因为在布设信标的过程中，相邻信标之间的距离是一定的。当获得了割草机器人与信标之间的距离和角度之后，就可以求出两杆之间的距离。当这个距离不满足相邻杆之间距离I时，说明此三角形为无效三角形。设割草 机器人到信标之间的距离分别为X和y，他们之间所夹的角度为α。需要注意的是，激光测距系统在测量时是存在误差的，这将导致根据其所测得的结果计算出的边界长度与实际长度存在偏差，造成无法正确判断所构成的三角形是否为有效三角形。为此，引入一个测距的误差量σ。根据三角形余弦定理，可列出算式:
权利要求
1.一种机器人虚拟边界建立与识别方法，其特征在于，所述方法包括: 51、机器人上的脉冲激光扫描探测模块勻速扫描一周； 52、判断是否检测到两个或两个以上的信标，若是，执行步骤S3，若否，返回执行步骤S1； S3、判断任意信标间的连线是否为虚拟边界，完成虚拟边界的建立； D4、计算机器人与虚拟边界间的距离，判断最短距离是否小于警戒距离，若是，单片机信息处理模块输出控制信号，控制机器人进行回避。
2.根据权利要求1所述的机器人虚拟边界建立与识别方法，其特征在于，所述步骤SI具体为: 加电复位时初始化； 通过中断O产生所需的频率信号，控制脉冲激光扫描探测模块旋转，覆盖以割草机器人为圆心，测距为半径的圆形区域； 通过中断I判断脉冲激光扫描探测模块是否转过一周。
3.根据权利要求1所述的机器人虚拟边界建立与识别方法，其特征在于，所述步骤SI还包括: 计算机器人到标杆的距离以及任意标杆相对于机器人之间的夹角。
4.根据权利要求3所述的机器人虚拟边界建立与识别方法，其特征在于，所述步骤S3具体为: 以割草机器人当前位置为固定点，获得若干三角形； 根据机器人到标杆的距离以及标杆相对于机器人之间的夹角利用三角形余弦定理求的两信标的距离，判断所得距离是否为预设距离，若是，则两信标间的连线为有效虚拟边界，若否，则两信标间的连线为无效虚拟边界。
5.根据权利要求4所述的机器人虚拟边界建立与识别方法，其特征在于，所述“判断所得距离是否为预设距离”具体为: 判断两信标间的距离是否满足_4η σ +I2 ≤ m2 ≤ 4η σ +I2，其中I为用三角形余弦定理求的两信标的距离，σ为测距的误差量，η为的最大测量距离。
6.根据权利要求1所述的机器人虚拟边界建立与识别方法，其特征在于，所述步骤S4中机器人与虚拟边界间的距离h=x*y*Sina /1，其中x和y分别为机器人到信标之间的距离，α为两信标与机器人的夹角，1为用三角形余弦定理求的两信标的距离，且a= t，ω为脉冲激光扫描探测模块的角速度，t为脉冲激光扫描探测模块转过两信标所用的时间。
7.—种如权利要求1所述的机器人虚拟边界建立与识别系统，其特征在于，所述系统包括:机器人及分布在真实边界上的若干信标，所述机器人中包括脉冲激光扫描探测模块、单片机信息处理模块以及虚拟边界建立与识别算法模块。
8.根据权利要7所述的机器人虚拟边界建立与识别系统，其特征在于，所述信标由金属杆以及围设于金属杆上的反光带构成。
9.根据权利要7所述的机器人虚拟边界建立与识别系统，其特征在于，所述脉冲激光扫描探测模块包括激光发射单元、激光接收单元及激光准直与聚焦单元。
全文摘要
本发明提供了一种机器人虚拟边界建立与识别方法及系统，该方法包括S1、机器人上的脉冲激光扫描探测模块匀速扫描一周；S2、判断是否检测到两个或两个以上的信标，若是，执行步骤S3，若否，返回执行步骤S1；S3、判断任意信标间的连线是否为虚拟边界，完成虚拟边界的建立；S4、计算机器人与虚拟边界间的距离，判断最短距离是否小于警戒距离，若是，单片机信息处理模块输出控制信号，控制机器人进行回避。本发明中的机器人虚拟边界建立与识别方法及系统定位精度较高，测量距离较长；由于激光的单色性好，系统抗外界干扰能力强；系统较为简单，成本低，且可靠性强、耗能少、重量轻。
文档编号G05D1/02GK103076802SQ20121037881
公开日2013年5月1日 申请日期2012年10月9日 优先权日2012年10月9日
发明者宋寿鹏, 苗永红, 李彦旭, 张恒, 卢翠娥, 姜琴, 赵偲 申请人:江苏大学