一种光学成像式轮式移动机器人方位的检测装置制造方法及图纸

本实用新型专利技术涉及一种光学成像式轮式移动机器人方位的检测装置，属于运动定位技术领域。本实用新型专利技术在轮式移动机器人车体安装光源、摄像机和图像处理器。摄像机拍摄地面图像，并将拍摄的图像传输给图像处理器，图像处理器接收摄像机输出的地面图像，测量相邻两帧图像的相对位置和方向的变化值，换算为移动机器人相对地面的位置和方向的变化值，最后将所有变化值分别累加，获得移动机器人相对起始点的位置和方向。本实用新型专利技术的检测方法和装置结构简单、使用方便、价格低廉，在原理上不受时间或机器人结构参数估值的影响，具有很高的长期精度，具有实际推广应用价值。（*该技术在2022年保护过期，可自由使用*）

Optical imaging type wheeled mobile robot position detection device

The utility model relates to a device for detecting the position of an optical imaging type wheeled mobile robot, which belongs to the technical field of motion positioning. The utility model relates to a wheeled mobile robot body mounting light source, a camera and an image processor. The camera will shoot the ground image, and image transmission to the image processor, the ground image processor receives the camera output, changes in the relative position and orientation measurement of two adjacent frames of the value change of conversion for the mobile robot position and orientation relative to the ground of the value, finally all change values were accumulated, for mobile robot the starting point of the relative position and direction. The utility test method and device has the advantages of simple structure, convenient use, low price, in principle without time or structural parameters of the robot's valuation, has very high accuracy, practical application value.

【技术实现步骤摘要】

本技术涉及一种光学成像式轮式移动机器人方位的检测装置，属于运动定位

技术介绍
随着社会发展和科技进步，机器人在当前生产生活中得到了越来越广泛的应用。轮式移动机器人由于其具有自重轻、承载大、机构简单、驱动和控制相对方便、行走速度快、机动灵活、工作效率高等优点，被大量应用于工业、农业、军事、医院、家庭、空间探测等领域。轮式移动机器人要完成指定的任务，首先要在移动过程中实时感知当前的位置和方位，并不断与目标位置和方位比较，控制移动机构进行相应的调整，最终到达目标位置，从而有效完成任务。检测移动机器人位置和方位的方法分为两类:自主检测法和参照物检测法。参照物检测方法要依赖磁条、路标、信标(如GPS信号)等外部参照物或参照信号来确定位置和方位，需要建立和维护参照物或参照信号；自主检测方法不需要在外部设立参照物或参照信号，利用机器人相对地球表面的运动来确定位置和方位，检测装置全部安装在机器人内部，工作时不依赖外部信息，因此不易收到外界干扰的影响。常用自主检测法主要有两种:(I)基于惯性传感器的测量方法。依据牛顿惯性原理，利用安装在移动机器人内部的加速度计和陀螺，分别测量机器人本身相对地球表面的线加速度和角加速度，对测量结果进行积分，从而计算出机器人移动的距离及方位变化。其缺点是:由于加速度的常值误差将引起与时间平方成正比的测量误差，因此任何小的常值误差都会随时间而无限增大，长期精度很差；每次使用之前需要较长的初始对准时间；惯性测量设备的结构复杂，价格较曰虫印贝ο(2)基于编码器的测量方法。利用安装在轮式移动机器人驱动系统中的编码器分别测量左、右驱动轮的转动角度，然后根据左、右驱动轮的转动角度推算出左、右驱动轮走过的距离，最后估算出机器人的位置和方位。基于编码器的测量方法结构相对简单、成本较低，但由于左、右驱动轮的实际直径不完全相等、有效轮距也在随时变化，因此基于编码器的测量方法的常值误差和测量误差也会随时间不断积累，长期精度也很差。如果出现驱动轮打滑现象，基于编码器的测量方法完全失效。上述两种位置和方位自主测量方法获得的测量结果是间接测量值。基于惯性传感器的测量结果是根据惯性传感器的加速度直接测量值间接计算出来的，测量结果不仅与惯性传感器加速度有关，而且还与时间的平方成正比；基于编码器的测量结果是根据编码器角位移直接测量值间接计算出来的，测量结果不仅与编码器角位移有关，而且还与驱动系统传动比、驱动轮直径及轮间距等参数有关。因此，时间、驱动系统传动比、驱动轮直径及轮间距等参数的估算误差都会传递到位置和方位的测量结果中，这些估算误差会随时间不断积累，导致上述两种测量方法的测量结果误差越来越大，长期精度变低。
技术实现思路
本技术的目的是提出一种光学成像式轮式移动机器人方位的检测装置，以克服现有技术中存在的定位测量误差随时间累计而无限增大导致的长期测量后定位精度变低的问题，以提高轮式移动机器人位置和方位的长期检测精度。本技术提出的光学成像式轮式移动机器人方位的检测装置，包括:光源，用于地面照明，所述的光源固定在轮式移动机器人的车体上；摄像机，用于拍摄地面图像，并将图像信号传送给图像处理器，所述的摄像机固定在轮式移动机器人的车体上；图像处理器，用于接收摄像机输出的图像信号，并进行预处理，测量相邻两帧图像的相对位置和方向的变化值，然后换算为移动机器人相对地面的位置和方向的变化值，最后将所有位置和方向变化值分别累加，获得移动机器人相对起始点的位置和方向，所述的图像处理器与摄像机相连接。本技术提出的光学成像式轮式移动机器人方位的检测装置，其优点是:利用本技术方法得到的测量结果，仅与机器人相对地面的相对位置和方向变化有关，与测量时间或移动机器人的结构参数估值无关，因此从理论上消除了众多误差因素的影响；移动机器人位置和方位的测量结果是多次直接测量值的累加，由于直接测量值的测量误差为随机误差，随着机器人移动距离的增大，直接测量值的数量也不断增加，测量误差的累加值将趋于零。因此本技术测量方法具有较高的长期测量精度，解决了现有检测技术测量误差随时间累计增大而导致的长期精度变低的问题。而且本技术的轮式移动机器人位置和方向的检测装置，结构简单、使用方便、价格低廉，在原理上不受时间或机器人结构参数估值的影响，有很高的长期精度，具有实际推广应用价值。附图说明图1是本技术检测装置的结构原理示意图。图2是本技术检测方法的坐标系与地面坐标系关系示意图。图3是本技术测量装置中摄像机采集的图像，其中(a)是一个采样间隔中的第一帧图像，(b)是一个采样间隔的第二帧图像。图1中，I是轮式移动机器人车体、2是图像处理器、3是摄像机、4是光源。具体实施方式本技术提出的光学成像式轮式移动机器人方位的检测装置，其结构如图1所示，包括:光源4，用于地面照明，所述的光源固定在轮式移动机器人的车体I上；摄像机3，用于拍摄地面图像，并将图像信号传送给图像处理器，所述的摄像机固定在轮式移动机器人的车体上；图像处理器2，用于接收摄像机3输出的图像信号，并进行预处理，测量相邻两帧图像的相对位置和方向的变化值，然后换算为移动机器人相对地面的位置和方向的变化值，最后将所有位置和方向变化值分别累加，获得移动机器人相对起始点的位置和方向，所述的图像处理器与摄像机相连接。本技术提出的光学成像式轮式移动机器人方位的检测方法中，图像处理器接收摄像机输出的地面图像，在第一帧地面图像中设定两个特征点M和N，并测量M和N在第一帧图像中的坐标值(Xmtl，Ym0)和(Xntl，Yntl )，再测量M和N在第二帧图像中的坐标值(Xml，Yml)和(Xnl，Ynl)，计算直线和直线之间的夹角Δ Θ 1，以及车体相对地面M点的位移Λ X2=Xml-XmO和Λ Y2=Yml_YmO，最后可根据Λ θ 1、Δ Xl和Λ Υ1，计算出移动机器人在第二帧图像时车体相对地面的平移距离增量Λ gl和Δ hl，最后将连续i个采样周期的移动机器人平移距离增量Λ gi和Λ hi,以及车体相对地面的转动角度变化Λ θ i分别累加，可得到第i个采样时刻时车体相对地面坐标系原点的位置g=Agl+Ag2+“*+Agi和h=Ahl+Ah2+*“+Ahi,以及方位角 θ =Δ θ 1+Δ Θ 2+…+ Δ Θ i0车体平移距离g和h的增量Λ g和Ah与地面M点在XOY坐标系中前一时刻的位置X、Y及位置变化Λ Χ、Λ Y，以及车体XOY坐标系相对地面xoy坐标系前一时刻的转动角度Θ和转动角度变化Λ Θ有关。图3中，Ca)是一个采样间隔的第一帧图像，(b)是一个采样间隔的第二帧图像。其中的M、N是地面上的两个特征点，在相邻的前后两帧数字图像中，M、N点的坐标值分别从(Xm0, Ym0)和(XnQ，Yn0)变化为(Xml，Yml)和(Χη1，Υη1)。α为MN两点连线在第一帧图像中的倾角，β为MN两点连线在第二帧图像中的倾角，MN两点连线在车体XOY坐标系中的偏转角度Δ θ 就是车体相对地面的转动角度变化Λ θ 10 Δ Θ j可利用两直线夹角计算公式计算:Δ Θ j=arc tan 其中tan α = (Yn0-Ym0) / (Xn0-Xni0), tan β = (Y本文档来自技高网...

【技术保护点】
一种光学成像式轮式移动机器人方位的检测装置，其特征在于该装置包括：?光源，用于地面照明，所述的光源固定在轮式移动机器人的车体上；?摄像机，用于拍摄地面图像，并将图像信号传送给图像处理器，所述的摄像机固定在轮式移动机器人的车体上；?图像处理器，用于接收摄像机输出的图像信号，并进行预处理，测量相邻两帧图像的相对位置和方向的变化值，然后换算为移动机器人相对地面的位置和方向的变化值，最后将所有位置和方向变化值分别累加，获得移动机器人相对起始点的位置和方向，所述的图像处理器与摄像机相连接。

【技术特征摘要】

【专利技术属性】
技术研发人员：高宏，王庆，
申请(专利权)人：紫光股份有限公司，
类型：实用新型
国别省市：