一种基于视觉的机器人里程计校正系统及方法
【技术领域】
[0001] 本发明设及一种基于视觉的机器人里程计校正系统及方法。
【背景技术】
[0002] 在移动机器人领域中，定位与导航是机器人实现自主运动的核屯、环节。导航是指 机器人按照预先规划路径或根据输入条件自主规划路径并实现运动的技术。定位是指机器 人通过对传感器获得的环境信息融合处理，实时确定机器人本体在全局环境中的位置信息 和航向信息的技术。定位是实现机器人导航的前提，所W使用高效准确的定位方案是实现 机器人可靠运行的关键。移动机器人一般通过使用里程计按照运动学模型对轮速信息进行 解算实现位置信息和航向信息的获取，但是该是一种相对定位方式，单纯使用里程计存在 累计误差，长时间或大尺度运行定位精度不高，为了提高里程计的精度需要对里程计进行 校正，目前里程计的校正方式主要有W下几种：
[0003] 1、巧螺仪校正里程计的方式。该方式是，首先里程计实时计算并输出机器人的位 置信息和航向信息，另外控制系统通过对巧螺仪数据积分得到机器人运动的航向角信息， 并将该航向角信息反馈给里程计，实现对里程计的校正。该方式属于相对定位方式，虽然该 方式有效降低了里程计的累计误差，但是累计误差仍然存在，另外该方式巧螺仪积分容易 受颠鑛等干扰影响，且对于数据的同步性要求高。
[0004] 2、在与具有激光定位或视觉定位功能的机器人系统中使用，通过激光和视觉等绝 对定位方式，结合先验环境信息，实现对里程计的校正。该方式虽然有效消除了累计误差， 但是该方式方案复杂，成本高，对于简单的机器人系统应用不合适。
[0005] 所W亟需一种方案简单，成本低，精度高，利于推广，尤其是适合在简单机器人系 统上应用的里程计校正方式，从而消除里程计累计误差，实现机器人位置信息和航向信息 的准确感知。
【发明内容】
[0006] 本发明为了解决上述问题，提出了一种基于视觉的机器人里程计校正系统及方 法，本方法有效消除里程计累计误差，提高里程计航迹计算精度，降低成本，尤其是在简单 的机器人应用系统中利于实现推广。
[0007] 为了实现上述目的，本发明采用如下技术方案：
[000引一种基于视觉的机器人里程计校正系统，包括移动机器人平台、工控机、行程计算 装置和视觉检测装置，其中，视觉检测装置设置于移动机器人平台前端，采集地面上预先设 置的标识线信息，将采集的标识线图像传输给工控机，工控机根据标识线图像确定移动机 器人的相对于标识线的航向角信息，工控机连接行程计算装置，行程计算装置接收速度传 感器的信号，对航迹进行计算，工控机根据行程计算装置计算的航迹和移动机器人相对于 标识线的航向角信息，对行程计算装置进行校正。
[0009] 所述航迹包括移动机器人位置信息和航向角信息。
[0010] 所述视觉检测装置，包括摄像机，摄像机镜头平面平行于运行路径上的标识线且 摄像机图像的垂直中轴线平行于标识线。
[0011] 所述标识线，为明显区别于地面的色带或线，标识线在机器人工作区域的全局航 向角信息是确定的。
[0012] 所述行程计算装置为里程计。
[0013] 一种基于上述系统的校正方法，包括W下步骤：
[0014] (1)移动机器人平台沿着预设的行走路径运动，保证标识线一直在摄像机视野中， 行程计算装置对移动机器人平台速度传感器信号进行实时检测，并对航迹（位置信息和航 向角信息）进行推算，将t时刻的机器人位置和航向角信息传输给工控机；
[0015] (2)工控机通过视觉检测装置获取t时刻标识线的图像，对该图像进行视觉处理， 计算出机器人相对于标识线的航向角信息，由于标识线在机器人工作区域的全局航向角 信息确定，所W机器人在工作区域全局中的航向角信息也可确定，此过程便实现了视觉定 位；
[0016] (3)工控机将上一步骤的航向角信息反馈给行程计算装置，行程计算装置通过加 权计算和补偿系数计算对自身的航向角信息进行校正，将校正后的航向角信息输入到行程 计算装置下一时间的航迹推算过程，完成了一个周期的里程计校正；
[0017] (4)重复步骤（1)-步骤（3)。
[0018] 所述步骤（1)中，航迹推算的方法为：按照公式：
【主权项】
1. 一种基于视觉的机器人里程计校正系统，其特征是：包括移动机器人平台、工控机、 行程计算装置和视觉检测装置，其中，视觉检测装置设置于移动机器人平台前端，采集地面 上预先设置的标识线信息，将采集的标识线图像传输给工控机，工控机根据标识线图像确 定移动机器人的相对于标识线的航向角信息，工控机连接行程计算装置，行程计算装置接 收速度传感器的信号，对航迹进行计算，工控机根据行程计算装置计算的航迹和移动机器 人相对于标识线的航向角信息，对行程计算装置进行校正。
2. 如权利要求1所述的一种基于视觉的机器人里程计校正系统，其特征是：所述视觉 检测装置，包括摄像机，摄像机镜头面平行于运行路径上的标识线且摄像机图像的垂直中 轴线平行于标识线，在摄像机周围安装有打光LED等阵列。
3. 如权利要求1所述的一种基于视觉的机器人里程计校正系统，其特征是：所述标识 线，为明显区别于地面的色带或线，标识线在机器人工作区域的全局航向角信息是确定的。
4. 一种基于如权利要求1-3中任一项所述的系统的校正方法，其特征是：包括以下步 骤： (1) 移动机器人平台沿着预设的行走路径运动，保证标识线一直在摄像机视野中，行程 计算装置对移动机器人平台测速传感器信号进行实时检测，并对航迹（位置信息和航向角 信息）进行推算，将t时刻的机器人位置和航向信息传输给工控机； (2) 工控机通过视觉检测装置获取t时刻标识线的图像，对该图像进行视觉处理，计算 出机器人相对于标识线的航向角，确定机器人在工作区域全局中的航向角信息，实现视觉 定位； (3) 工控机将视觉定位计算出的航向角信息反馈给行程计算装置，行程计算装置通过 加权计算和补偿系数计算对自身的航向角进行校正，将校正后的航向角输入到行程计算装 置下一时间的航迹推算过程，完成了一个周期的里程计校正； (4) 重复步骤（1)-步骤（3)。
5. 如权利要求4所述的校正方法，其特征是：所述步骤（1)中，航迹推算的方法为： 按照公式：
其中Sr (t-1)，Sl (t-Ι)分别为移动机器人平台右轮和左轮在t-Ι时刻到t时刻时间间 隔走过的距离，d为移动机器人平台轮距； 输出t时刻机器人位置信息和航向角信息[X (t)，Y (t)，W(t)]，并将该数据通过通信线 上传到工控机。
6. 如权利要求4所述的校正方法，其特征是：所述步骤（2)中，工控机通过视觉检测装 置获取t时刻标识线的图像，并对该图像进行视觉处理，处理步骤包括： (2-1)图像标定：使用相机标定阶段获取的标定参数对每一帧图像进行标定，以消除 相机镜头带来的图像畸变； (2-2)对彩色对象进行颜色模型转变，需要识别的是有颜色的标识色带或线，需要通过 对图像感兴趣的颜色模型进行提取； (2-3)目标图像分割，提取出特征对比图像； (2-4)形态学处理，通过图像结构元素对图像特征进行度量和提取，通过腐蚀和膨胀的 形态学方法对图像处理，以方便对特征的识别和分析； (2-5)提取目标特征，通过边缘检测确定每行目标特征中心点坐标，通过粒子分析计算 出标识线与图像垂直中轴线的夹角，确定机器人在工作区域全局中的航向角信息w(t)，即 实现视觉定位。
7. 如权利要求5所述的校正方法，其特征是：所述步骤（2-2)中，具体方法为：系统使 用的彩色图形处理空间模型为HSI模型，该模型受光照条件变化的影响小，H代表色调、S代 表饱和度、I代表亮度，把RGB模型转换为HSI模型图像。
8. 如权利要求5所述的校正方法，其特征是：所述步骤（2-3)的具体方法为：目标图像 分割，在HSI模型图像中选择RIO (关注区域），通过学习阶段确定的H和S的阈值对图像进 行分割，提取出特征对比图像。
9. 如权利要求5所述的校正方法，其特征是：所述步骤（2-5)中，目标特征提取使用的 方法是使用8连通域对图像进行扫描。
10. 如权利要求4所述的校正方法，其特征是：所述步骤（3)中，计算得到的航向角 w(t)下传给里程计，里程计通过加权计算和补偿系数计算对里程计本体的航向角W(t)'进 行校正，校正公式如下： W (t)' = c*ff (t) + (1-c) *w (t) +Pe 上式中c为权值系数，通过在调试过程中根据经验进行设定，Pe为补偿系数，因为里程 计和视觉图像处理过程中数据存在不同步，在校正公式中加入一定量的补偿系数，这一补 偿系数要结合系统采样速度和计算速度而定，校正得到的航向角W(t) '在输入到里程计新 周期t+Ι时刻的航迹推算过程中即完成了一个周期的里程计校正。
【专利摘要】本发明公开了一种基于视觉的机器人里程计校正系统及方法，系统包括移动机器人平台、工控机、行程计算装置和视觉检测装置，其中，视觉检测装置设置于移动机器人平台前端，采集地面上预先设置的标识线信息，将采集的标识线图像传输给工控机，工控机根据标识线图像确定移动机器人相对于标识线的航向角信息，工控机连接行程计算装置，行程计算装置接收速度传感器的信号，对航迹进行计算，工控机根据计算的航迹和移动机器人相对于标识线的航向角信息，对行程计算装置进行校正。本发明通过视觉定位这一绝对定位方式与里程计航迹推算这一相对定位方式的结合，有效的消除了里程计航迹推算过程中普遍存在的累计误差问题。
【IPC分类】G01C25-00
【公开号】CN104864889
【申请号】CN201510287924
【发明人】刘加科, 孔令文, 田晓璐, 付崇光, 韩磊, 孙凯, 秦振华
【申请人】山东鲁能智能技术有限公司
【公开日】2015年8月26日
【申请日】2015年5月29日