一种基于行动机器人的分布式视觉定位系统及方法
【技术领域】
[0001]本发明涉及一种机器人导航技术领域，尤其是涉及一种基于行动机器人的分布式视觉定位系统及方法。
【背景技术】
[0002]近年来，随着科技的发展，行动机器人在服务、探测、物流等领域得到越来越广泛的应用。而要对行动机器人快速定位和导航成为实现智能化的关键。
[0003]目前行动机器人很多只靠自身的安装的传感器或摄像头对环境进行检测和建立，而没有涉及到机器人与外部视觉设备协同定位的技术，这大大限制了机器人的工作职能，降低了工作效率。特别在室内如办公室环境中存在多种大物体，当行动机器人在移动时，需要获得精确定位和室内环境信息，分布式视觉定位系统就能解决这方面的问题。
【发明内容】
[0004]本发明主要是解决现有技术行动机器人定位不准确，工作效率低的问题，提供了一种协同定位、定位准确的基于行动机器人的分布式视觉定位系统。本发明还提供了一种基于行动机器人的分布式视觉定位方法。
[0005]本发明的上述技术问题主要是通过下述技术方案得以解决的:一种基于行动机器人的分布式视觉定位系统，包括设置在室内环境中的视觉节点、行动机器人和控制服务器，所述视觉节点包括多个摄像头单元，所述控制服务器包括图像处理单元、定位单元和地图单元，摄像头单元分别与图像处理单元连接，图像处理单元和地图单元分别与定位单元相连，定位单元与行动机器人相连接，在行动机器人上设置有特征标示。本发明能准确定位行动机器人在室内的位置，大大提高了行动机器人的工作职能，提高了工作效率。多个摄像头单元分布在室内环境中，形成多视觉节点协同定位。摄像头单元将拍摄到的图像传送给图像处理单元处理，图像处理单元对图像进行特征点提取，判断行动机器人是否进入图像。定位单元根据处理后的图像对行动机器人进行位置定位，同时根据地图单元储存的环境地图在地图上定位并显示行动机器人。特征标示设置在行动机器人表面上，用于识别机器人以及定位用。各单元之间通过IPC进行通信。
[0006]作为一种优选方案，所述图像处理单元包括依次连接的图像增强模块和边缘提取模块，图像增强模块分别与摄像头单元连接，边缘提取模块与定位单元连接。通过图像增强模块和边缘提取模块的处理，将图像中行动机器人上的特征标示提取出来，作为后续定位计算。图像增强模块对图像进行灰度化、二值化处理。轮廓提取模块采用改进的Canny算子算法提取主体识别点和距离识别点的边缘。
[0007]作为一种优选方案，所述处理单元上设置有显示单元。显示单元能显示当前环境地图，并能将定位后的行动机器人显示在环境地图中，使得操作者直观看到行动机器人当前位置。
[0008]作为一种优选方案，控制服务器还包括有导航单元，导航单元与定位单元相连接。导航单元对行动机器人移动进行导航，在导航路线设定后，通过定位单元对行动机器人在地图上进行定位，确定行动机器人在导航过程中的位置，然后再根据导航路线控制行动机器人进行移动。
[0009]作为一种优选方案，行动机器人包括激光传感单元，激光传感单元与定位单元相连接。激光传感单元对行动机器人前方障碍进行扫描，同时能测得行动机器人到障碍的距离，将检测到的数据发送给定位单元，能在地图上进行显示。
[0010]作为一种优选方案，所述摄像头单元之间通过网络互相连接。摄像头之间通过IPC(Inter-Process Communicat1n)进行通信。摄像头单元之间能进行同步操作，将同一时刻的图像发送给控制服务器进行处理。
[0011]作为一种优选方案，所述特征标示包括设置在行动机器人表面正中的识别条，识别条为长发形，识别条长度为标示长度。主体识别点在图像上用于识别行动机器人，在图像处理单元中提取到识别条，检测到行动机器人进入拍摄该图像的摄像头单元范围内。并根据识别条长度来推算出行动机器人到拍摄的摄像头单元之间的距离。
[0012]一种基于行动机器人的分布式视觉定位方法，包括以下步骤:
S1.分别对各摄像机单元设定不同距离进行标定，获取图像坐标系内标示长度和全局坐标系内标示长度之比与距离的关系表；即在各不同距离进行标定时，记录标示长度在图像坐标系内长度与标示长度在全局坐标系内长度的比值，这样就可以根据图像中检查到的标示长度推导出距离。每隔一个距离进行一次标定，标定采用Halcan标定算法进行操作，获取摄像机单元内外参数，得到图像坐标到全局坐标的转换。
[0013]S2.摄像头单元开始工作，每隔一时段将同时采集的图像发送给图像处理单元分别进行处理，图像处理单元对图像中特征标示进行边缘提取，根据边缘计算出特征标示中标示条边界像素数据，根据这些像素数据确定标示条像素数据；
S3.计算图像坐标系内标示长度和全局坐标系内标示长度之比，选取标定中与其最接近的比值，获得行动机器人到摄像单元的距离值，根据距离值在环境地图上对行动机器人进行定位。
[0014]作为一种优选方案，步骤S1中对摄像机标定过程为:采用标定板进行标定，将标定板在摄像机单元工作距离设定范围内，每隔固定间距进行一次标定，获得每个距离的摄像机内外参数。一般设定在800~1500cm距离内，每隔50cm进行一次标定。本方案采用Halcan标定算法进行操作。
[0015]作为一种优选方案，步骤S2中标示长度像素数据获取具体包括以下步骤:
S21.对图像进行灰度化、二值化处理；该处理方法为已公开的技术，具体内容可以参见文献:刘广起，郑晓势，张晓波。基于图像纹理特征提取的车牌定位算法[J]。中国图象图形学报，2005，10(11): 1419-1422。
[0016]S22.采用改进的Canny算子算法提取提取识别条轮廓；经过处理提取得到的识别条是许多点构成的这样一个图像。该改进的Canny算子算法为已知公开的技术，具体内容可以参见文献:李庆利，张少军，李忠富等。一种基于多项式插值改进的亚像素细分算法[J]。北京科技大学学报，2003，25(3): 280-283。对识别条提取轮廓时，其重要特征点分布在水平方向和竖直方向，只需要求出水平和垂直边缘的梯度方向即可，其它方向的点都是不必要点，梯度方向也不需要求出，因此采用水平、垂直模板方向进行轮廓检测。采用的水平、垂直模板。
[0017]S23.获取识别条各边界线的点集合，
从下到上逐列扫描每个像素，遇到白点输出坐标，然后转向下一列继续扫描，并输出白点坐标，直到扫描结束，输出下边界线所有点集；
从右到左逐行扫描每个像素，遇到白点输出坐标，然后转向下一行继续扫描，并输出白点坐标，直到扫描结束，输出右边界线所有点集；
从上到下逐列扫描每个像素，遇到白点输出坐标，然后转向下一列继续扫描，并输出白点坐标，直到扫描结束，输出上边界线所有点集；
从左到右逐行扫描每个像素，遇到白点输出坐标，然后转向下一行继续扫描，并输出白点坐标，直到扫描结束，输出左边界线所有点集；
524.分别对各边界线的点集进行最小二乘法拟合，拟合得到各边界线，根据边界线交点获得识别条四个角点的坐标，根据四个角点坐标计算出识别条中心坐标；
525.取上边界的两个角点，若两角点处于同一直线上，将两角点点列坐标进行相减获得标示长度值，若两角点不处于同一直线上，将两角点列坐标进行相减获得直边长度值，将两角点横坐标进行相减获得横边长度值，然后计算出标示长度值。
[0018]因此，本发明的优点是:准确定位行动机器人在室内的位置，大大提高了行动机器人的工作职能，提高了工作效率。多个摄像头单元分布在室内环境中，形成多视觉节点协同定位。
【附图说明】
[0019]附图1是本发明的一种结构框示图；
附图2是本发明的一种方法流程示意图。
[0020]1-视觉节点2-控制服务器3-行动机器人4-摄像头单元5-图像处理单元6-定位单元7-地图单元8-显示单元9-图像增强模块10-边缘提取模块11-导航单元12-激光传感单元。
【具体实施方式】
[0021]下面通过实施例，并结合附图，对本发明的技术方案作进一步具体的说明。
[0022]实施例:
本实施例一种基于行动机器人的分布式视觉定位系统，如图1所示，包括设置在室内环境中的视觉节点1、行动机器人3和控制服务器2。视觉节点包括多个摄像头单元4，摄像头单元之间通过IPC相连接。控制服务器包括图像处理单元5、定位单元6、地图单元7、导航单元11和显示单元8，其中图像处理单元又包括图像增强模块