[发明专利]移动体视觉导航用多功能路标及综合导航方法

说明书

【技术领域】：

本发明属于移动体的视觉导航技术领域。

【背景技术】：

视觉导航是移动体领域中的一个重要研究方向，具有很好的应用前景。

目前，视觉导航大致分为两类，一类需要事先建模，且算法复杂，实时性不高；另一类基于人为铺设的路标，这种方法不需要事先建模，且路径灵活，但因为需要对整个场景进行搜索而导致算法复杂，实时性差，观测物易丢失。

【发明内容】：

本发明目的是解决现有导航方法实时性不高、造价昂贵、路径不易改变等问题，提供一种简单、经济，路径可随意改变且实时性高的移动体视觉导航算法及适合该算法的路标。

本发明提供的移动体视觉导航用多功能路标设计为表盘式组合结构，路标主体是半径为R的圆盘，圆盘圆心为路标中心，圆盘上设有两个用于指示下一路标所在方向和判断车体是否偏转的指针状结构的路标辅助部分，即第一辅助部分和第二辅助部分；路标的主体与辅助部分采用两种不同的颜色。

路标辅助部分形状设计为梯型结构，其宽度为R，辅助部分内侧距离圆心为R/2，其中路标的第二辅助部分能够以圆盘的圆心为中心正负旋转90度。

一种移动体的综合导航方法，包括：

1)、将一组以上所述的多功能路标序列水平间隔铺设在移动体移动路径的上方；

2)、路标的识别定位，包括：

计算搜索范围；

对搜索范围内的图像进行前期处理；

计算路标的位置；

3)移动体导航，包括：

步骤1：判断是否需要寻找下一个路标，即判断当前路标中心纵坐标是否大于设定阈值T(需要寻找新路标的阈值)，如果是则利用路标的第二辅助部分与路标中心预测下一路标所在方位，并将下一路标设为当前路标；

步骤2：利用路标中心与图像中心或路标第一辅助部分的关系，判断移动体是否跑偏，如果是则计算移动体的偏转角度。

所述的对搜索范围内的图像进行前期处理包括，对搜索范围内的图像进行颜色识别，利用路标主体部分和辅助部分的比例关系和位置关系排除其它颜色类似但不是路标的物体的干扰。

所述的计算路标的位置包括：

利用路标主体部分和辅助部分的比例关系和位置关系计算路标的中心位置；

在中心位置附近进行模板匹配，精确定位路标的中心位置。

本发明的优点和积极效果：

1、设计了一种新型路标，与传统路标相比，该路标为组合式结构，可以较好的排除颜色类似但非路标的物体的干扰，可以用于复杂环境。2、所发明的路标可以采用纸张、塑料等材质制成，非常经济，并且该路标结构简单，铺设方便，路径可随意改变。3、基于该路标的导航算法不仅可以对车体进行定位，还可以方便的计算车体的偏转角度，从而进行纠偏。4、基于该路标的导航算法不用对整幅图像进行处理，减少了计算量，提高了系统的实时性。5、基于该路标和导航算法的移动体不仅可以前进，还可以按原路线返回。

【附图说明】：

图1为路标外形示意图；

图2为导航算法流程图；

图3为预测下一路标位置示意图；

图4为路标中心不在图像中心时的移动体偏转角度示意图；

图5为路标中心在图像中心时的移动体偏转角度示意图；

图6为导航场景图；

图7为路标定位实例图；

图8为预测下一路标位置实例图；

图1中，1路标主体，2路标第一辅助部分，3路标第二辅助部分。

图4，图5中，虚线为移动体无偏转时的图片和路标在图片中的位置，实线为移动体偏转时的图片和路标在图片中的位置。

图7中，4搜索范围，5识别结果，6定位结果

图8中，7下一路标预测结果，8识别结果，9搜索范围。

【具体实施方式】：

实施例1：多功能路标设计

如图1所示，本发明提供的移动体视觉导航用多功能路标设计为表盘式组合结构，路标主体1是半径为R的圆盘，圆盘圆心为路标中心，圆盘上设有两个用于指示下一路标所在方向和判断车体是否偏转的指针状结构的路标辅助部分，即第一辅助部分2和第二辅助部分3；路标的主体与辅助部分采用两种不同的颜色，如主体采用黄色，辅助部分采用紫色。

路标辅助部分形状设计为梯型结构，其宽度为R，辅助部分内侧距离圆心为R/2，其中路标的第二辅助部分3能够以圆盘的圆心为中心正负旋转90度。

实施例2：综合导航方法

移动体的综合导航方法，包括：

1)、将一组实施例1所述的多功能路标序列水平间隔铺设在移动体移动路径的上方；

2)、路标的识别定位，包括：