[发明专利]基于视觉的组合导航机器人及导航方法

权利要求书

1.一种基于视觉的组合导航机器人，其特征在于，包括：

四轮驱动小车，所述小车车体上安装彩色数码摄像机；车体的前端和后端各安装若干个超声波传感器，用于检测机器人周围障碍物距离信息；车体内部安装陀螺仪，用来检测机器人姿态信息；四个光电编码器分别安装在四套伺服驱动电机上，作为里程计使用；电机控制器；机器人车体控制系统计算机，用于保证图像处理和控制的实时性。

2.根据权利要求1所述的基于视觉的组合导航机器人，其特征在于，还包括机器人通讯系统，用于以无线通信方式与远程操作台通讯。

3.根据权利要求1所述的基于视觉的组合导航机器人的导航方法，其特征在于，包括以下步骤：

在所述机器人车体控制系统计算机内设置路径参数，所述路径参数包括机器人距离车道线距离、距离道路边缘的距离，机器人距离转弯标识的距离；

机器人通过摄像机采集图像信息，寻找车道线，如果识别到车道线，则沿车道线行走；如果找不到车道线，则寻找道路边缘的植被分界线，如果识别到道路边缘的植被分界线，则沿着该道路边缘行走；如果识别到转弯标识，则进行转弯。

4.根据权利要求3所述的基于视觉的组合导航机器人的导航方法，其特征在于，包括以下步骤：

所述机器人直线行驶时，通过摄像机检测出的车道线实时计算当前小车和车道线之间的第一横向位移和第一行驶角度偏差；

实时用光电编码器和陀螺仪的计算当前小车和车道线之间的第二横向位移和第二行驶角度偏差；所述横向位移即为机器人中心与车道线或道路边缘的垂直距离，行驶角度偏差即为机器人当前行驶方向和欲行驶的规划路线之间的夹角；

将每次获取的根据视觉计算出的小车和车道线之间的横向位移以及行驶角度偏差数据与用光电编码器和陀螺仪的计算当前小车和车道线之间的横向位移以及行驶角度偏差数据相比较；

如果第一横向位移与第二横向位移的偏差大于第一位移偏差设定值，或者第一横向位移与第二横向位移的偏差大于第二位移偏差设定值并且第一行驶角度偏差与第二行驶角度偏差大于角度偏差设定值，则小车的直线行走采用光电编码器和陀螺仪计算的数据纠偏，否则采用根据视觉计算出的数据导航。

5.根据权利要求3或4所述的基于视觉的组合导航机器人的导航方法，其特征在于，包括以下步骤：

所述机器人通过视觉检测人工设置标识得到机器人转弯信号，为防止机器人在未检测到标识的情况时会出现失控现象，所以同时将光电编码器获取的距离数据进行融合，在光电编码器数据超出设置数据时则认为机器人未检测到标识，机器人则按照光电编码器设置数据转弯，机器人转弯采用差动转向方法，差动转向过程中机器人会因为车轮滑动导致转角存在一定偏差，为减少偏差，使用陀螺仪检测转角，对转角进行补偿，最大程度减少误差。

6.根据权利要求5所述的基于视觉的组合导航机器人的导航方法，其特征在于，包括以下步骤：在机器人直行或转弯时，所述超声波传感器实时采集障碍物信息，遇到障碍物则停车报警，保证机器人以及周围环境安全。