一种机器人自主行走的方法
【技术领域】
[0001]本发明涉及智能机器人、人工智能、视频图像处理技术领域。尤其是涉及一种利用视频图像处理技术的机器人自主行走的方法。
【背景技术】
[0002]自主行走机器人需要感知外界环境，实现向目的地自主行走并能进行避障处理。
[0003]中国发明专利申请号为200910195432.1专利公开了一种机器人餐厅多机器人自动定位系统，该系统中央服务器模块由全景定位模块、定位信息融合处理模块、人机交互模块组成，其中:全景定位模块由餐厅顶部安装全景相机与在地面安装栅格形成栅格坐标系构成；每个餐厅机器人均有双目视觉定位模块、红外信标定位模块、红外测距定位模块、射频识别模块、陀螺仪定位模块；中央服务器模块对餐厅每个机器人进行全局定位，每个机器人用多种定位方式独立确定自己的位置。该系统的不足之处在于需要改变环境、并对地面环境有特定的要求，实用性较差，成本较高。
[0004]中国发明专利申请号为201010189865.9专利公开了一种基于机器人双目立体视觉的地面障碍物检测方法，采用双目立体视觉传感器检测地面障碍物，通过对图像进行地面视差分布分析，分辨出图像中的地面和障碍物，建立栅格地图，进行避障。该方法的不足之处在于计算复杂、实时性较差、实时定标不准。
[0005]中国发明专利申请号为201210311035.8专利公开了一种基于GIS的智能家庭机器人系统，该系统是用GIS模块实现室内电子地图动态构建，通过该电子地图控制机器人在室内行走。该系统的不足之处在于，许多室内GIS信号不好或没有GIS信号，使用该系统需要增加增强GIS信号的设备，另外GIS的定位精度通常在3?5米，不能用于定位精度较高的场合。
【发明内容】
[0006]为了克服现有自主行走机器人定位不准、实时性差、成本高的不足。本发明的目的是提供一种机器人自主行走的方法，该方法定位准、实时性高、成本低。
[0007]本发明的目的通过以下技术方案实现:
[0008]一种机器人自主行走的方法，其特征在于:该方法采用机器人系统，该系统包括能行走的机器人，在机器人上安装有处理机和图像采集设备；处理机包括处理器、存储设备、输入设备和输出设备，处理机装有操作系统和应用程序；具体步骤如下:
[0009]A.生成导航信息；步骤如下:
[0010]Al.赋采集点编号i初值:系统赋采集点编号初值i = I ;
[0011]A2.接收输入信息:系统接收输入信息；
[0012]A3.结束行走判断:如果系统收到结束行走的信息，系统控制机器人停止行走，转步骤A8 ;否则转步骤A4 ；
[0013]A4.机器人行走:如果系统没有收到过任何行走信息，或者系统收到停止行走信息，系统控制机器人停止行走；如果系统收到行走信息，系统依据收到行走信息所述的行走模式控制机器人进行行走；如果系统收到过行走信息，在系统没有收到改变行走信息前，系统依据原来的行走模式控制机器人进行行走；所述的行走是指直线行走、旋转行走，直线行走是指向前直线行走、向后直线行走，旋转行走是指左转行走、右转行走，左转行走是指向前左转行走、向后左转行走，右转行走是指向前右转行走、向后右转行走；所述的行走模式是机器人行走的模式；
[0014]A5.生成采集点i判断:到达行走距离，或者系统首次收到机器人行走信息，或者系统收到改变机器人行走模式的信息，转步骤A6 ;否则，转步骤A2 ;所述的到达行走距离是指机器人行走的距离多系统设定的采集点之间的距离，机器人行走的距离是指机器人从前一个采集点到目前机器人位置之间的距离；测量机器人行走的距离是用测量距离的方法测量机器人行走的距离；
[0015]A6.生成米集点i导航?目息:系统生成米集点i导航?目息；米集点i导航?目息是采集点编号1、M(i，W(i))、GS(i)与FS(i，R(i));其中，M(i，W(i))是机器人从采集点i向采集点i+Ι行走的行走模式；W(i)是机器人旋转行走的旋转量，如果机器人直线行走W(i)=O ;GS(i)是系统在采集点i读取的图像；FS(i，R(i))是GS⑴的匹配数据，R(i)=
1,2,…，N(i)，N(i)是图像GS⑴中匹配数据的数量；匹配数据是指图像匹配所需的数据；
[0016]A7.增加采集点编号1:系统对采集点编号i加I ;转步骤A2 ;
[0017]A8.结束处理:系统置I = i ;系统生成米集点I导航?目息；1是行走路线上米集点的数量，行走路线是机器人行走所形成的路线；
[0018]Α9.生成导航信息:系统用所述的采集点数量I和所述的采集点i的导航信息，i=1，2，…，I，生成导航彳目息；
[0019]A10.存储导航彳g息:系统存储所述的导航ig息；
[0020]B.设置标注点；步骤如下:
[0021]B1.取出导航信息:系统取出所述的导航信息；
[0022]B2.设置标注点:操作者依据所述的行走路线上的采集点设置M个标注点；系统按照标注点与所述的采集点读取图像的位置最接近，将这M个标注点设置为标注点m，标注点m分别与采集点im读取图像的位置最接近；其中，m是标注点的编号，im是采集点的编号，m = 1，2，...，M，im = il, i2,…，iM，I 彡 M 彡 I ;
[0023]B3.存储标注点信息:系统存储所述的标注点信息；标注点信息是指所述的标注点数量M和标注点m信息，m = 1，2，…，M，M多I ;其中，标注点m信息是标注点编号m、标注点m对应的采集点编号im ;对应是指标注点m与采集点im读取图像的位置最接近；
[0024]C.自主行走:步骤如下:
[0025]Cl.取出信息:系统取出所述的导航信息和所述的标注点信息；
[0026]C2.设定行走路线:根据需要操作者设定机器人从标注点s行走到标注点e的路线，s # e ;
[0027]C3.确定初始点d:系统在i e [I, I]范围内得到点P，点P即为初始点d ;
[0028]C4.形成导航数据:系统根据所述的初始点d和所述的设定行走路线，形成自主行走的路线为从初始点d到标注点S，再从标注点s到标注点e ;并对应该路线生成自主行走的导航采集点，这些采集点的编号依次为d，d+1, d+2,…，js, js+1,…，je，共J个采集点；其中:js是标注点s的米集点编号，je是标注点e的米集点编号；
[0029]C5.赋采集点编号j初值:系统赋采集点编号初值j = d ;
[0030]C6.初始点位置判断:如果初始点d是标注点S，转步骤C12 ;否则转步骤C7 ;
[0031]C7.自主行走:系统根据所述的米集点j导航?目息和米集点j+Ι导航?目息控制机器人从米集点j自主向米集点j+Ι行走；
[0032]C8.图像匹配:图像匹配的步骤如下:
[0033]C81.读取图像:系统读取机器人所在位置的图像GA ;
[0034]C82.得到匹配数据:系统对图像GA进行处理得到匹配数据FA(R)，R = I, 2，…，N，N是图像GA中匹配数据的数量；
[0035]C83.图像匹配:系统用匹配数据FA(R)与匹配数据FS(j+1，R(j+1))进行图像匹配处理；
[0036]C9.调节行走:系统根据所述的图像匹配的结果，如果发现机器人行走中向右偏离行走路线，系统调节机器人按行走方向左转行走；如果发现机器人行走中向左偏离行走路线，系统调节机器人按行走方向右转行走；行走方向是指行走方向向前，或行走方向向后；
[0037]C10.避障处理:在机器人行走中，系统发现障碍物，系统控制机器人停止行走并提示有障碍物，或系统控制机器人绕行障碍物；其中，发现障碍物是指系统通过测量机器人与物体之间距离的方法发现障碍物，或者系统用图像匹配发现障碍物；系统用图像匹配发现障碍物是指系统读取机器人所在位置的图像GA，系统用图像GA与图像GS(n)进行图像匹配处理，根据图像匹配的结果发现障碍物，η是采集点编号，D+j彡η彡j，D彡0，j是采集点的编号；系统控制机器人绕行障碍物的步骤如下:
[0038]C101.从一边绕行障碍物:系统控制机器人从障碍物的一边绕行，绕行中生成绕行信息；如果机器人绕行成功，转步骤C105 ;否则，转步骤C102 ;其中:绕行信息是指机器人绕行中系统生成的采集点数量T和采集点t的导航信息，t = 1，2，…T ;采集点t导航信息是米集点编号t、M(t, ff (t))、GS (t)与FS (t, R(t));绕行米集点t导航彳目息是系统在绕行起点生成的导航信息，或到达行走距离生成的导航信息，或系统控制机器人绕行改变机器人行走模式时生成的导航信息，或系统在绕行终点生成的导航信息；
[0039]C102.退行回到绕行起点:系统根据所述的绕行信息生成退行信息；系统根据退行信息控制机器人按原绕行路线退回到绕行起点；其中:退行信息是所述的采集点数量T和退行米集点t的导航彳目息，t = 1，2，...T ;退行米集点t的导航彳目息是退行米集点编号t、Mb(t，W(t))、GSb(t)与FSb(t，R(t))，Mb(t)是机器人从退行采集点t+Ι向退行采集点t行走的行走模式；系统根据所述的绕行信息生成退行信息是指系统设置GSb (t) = GS (t)、FSb (t, R(t)) = FS (t, R(t))、Mb(t, ff(t))取 M(t, W(t))相反的行走模式，t = 1，2，…，T ;向前直线行走与向后直线行走互为相反行走模式，向前左转行走与向后右转行走互为相反行走模式，向前右转行走与向后左转行走互为相反行走模式；系统根据退行信息控制机器人按原绕