移动机器人原理与技术 课件 第3、4章 移动机器人的传感器、移动机器人定位_第1页
移动机器人原理与技术 课件 第3、4章 移动机器人的传感器、移动机器人定位_第2页
移动机器人原理与技术 课件 第3、4章 移动机器人的传感器、移动机器人定位_第3页
移动机器人原理与技术 课件 第3、4章 移动机器人的传感器、移动机器人定位_第4页
移动机器人原理与技术 课件 第3、4章 移动机器人的传感器、移动机器人定位_第5页
已阅读5页,还剩96页未读 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

移动机器人技术原理与应用第三章

移动机器人的传感器移动机器人外部传感器移动机器人视觉原理3.1移动机器人内部传感器3.23.33.1移动机器人内部传感器移动机器人内部传感器主要是指能够测量移动机器人自身位置、移动速度、移动加速度等直线位移相关量和偏转、俯仰和回转等转动角度和转动速度、转动加速度等转动相关量。3.1.1位置传感器设定位置或者角度的零位和极限位置对保护移动机器人的运动关节的安全动作起着重要作用。3.1.1位置传感器电位器通过电阻把位置或角度(角度和位置的原理一样,只是把电阻做成弧形)信息转化为随位置或角度变化的电压,当滑动触头随位置变化在电阻器上滑动时,触头接触点变化前后的电阻阻值与总阻值之比就会发生变化,在功能上电位器充当了分压器的作用,因此其电压输出将与电阻阻值成比例,这样就把位置信息转化为电信号。3.1.2位移和角度测量传感器旋转运动的角度和直线运动的位移经常会作为移动机器人的位姿信息,从测量方法上,可分为两种。一种是模拟式测量,将要测的位移量变换成电流、电压等进行测量,常用器件为电位器等。另一种是数字式测量,将位移量变换成脉冲每个脉冲与单位位移相对应,检测元件输出脉冲数。3.1.2位移和角度测量传感器编码器是一个广泛使用的位置传感器,能够检测细微的运动,其输出为数字信号。为了测量位置信息,检测细微的运动,码盘或码尺被划分为若干区域。每个区域可能是透光的或不透光的。由发光二极管作为光源,与之相对应的对光信号进行检测的是光敏传感器,如光电晶体管。当码盘或码尺采用透光方式进行检测,光源和光敏传感器被安装在码盘或码尺的两侧;当码盘或码尺采用反射光方式进行检测,光源和光敏传感器被安装在码盘或码尺的同侧。3.1.2位移和角度测量传感器(a)投射式测量转角的旋转增量编码器

(b)反射式测量直线运动的直线增量编码器(c)装配有增量编码器的电机

(d)增量码盘编码器的工作原理与结构3.1.2位移和角度测量传感器当光源发射的光线通过码盘或码尺的透光或反射被光敏传感器接收到时,传感器导通输出高电平;当光源发射的光线由于码盘或码尺的遮挡或散射等原因使光敏传感器接收不到光信号时,传感器关断,输出信号低电平。随着码盘的转动或码尺的移动,传感器就会连续不断的输出信号,通过对该信号进行计数就可以测量角位移或线位移。3.1.2位移和角度测量传感器编码器有增量式编码器与绝对式编码器两种基本形式。上图所示的增量式编码器中,其透光和不透光(反光或不反光)的区域尺寸相同且交替出现。由于这些区域尺寸相同,均匀分布在码盘或码尺上,因此每个区域所表示的旋转角度或直线位移也都是相同的。增量式编码器可以检测运动的变化,而对于位置信息,只有在获知编码器初始位置的情况下才可以确切给出。3.1.2位移和角度测量传感器使用增量式编码器进行位置检测的系统一般在开始工作时都要进行复位,在已知复位位置的前提下就可以确定系统任意时刻的角位移。除了获取精确位置信息外,还需要知道系统是顺时针运动还是逆时针运动。单一码道(弧圈)的增量式编码器无法对此进行判断,一般通过在码盘上设计两个码道(弧圈)的方式解决,保证每个码道的输出脉冲间相差1/2拍,通过判断那个通道输出的上升沿或下降沿先于另一通道出现来确定转动方向。3.1.2位移和角度测量传感器增量式编码器的输出信号3.1.2位移和角度测量传感器对于增量式编码器,通过对码道输出的上升沿和下降沿进行检测可以在不增加码道的情况下提高分辨率。绝对式编码器上每个位置对应于一个唯一的编码信息,无需已知初始位置就可以确定任意时刻码盘上的精确位置。绝对式编码器工作原理3.1.2位移和角度测量传感器绝对式编码器的码盘设计与增量式编码器有很大不同,其码盘是由多圈弧段组成,每圈互不相同,沿径向方向各弧段的透光和不透光部分(反射和未反射部分)组成唯一编码指示精确位置。

8位绝对格雷码码盘3.1.2位移和角度测量传感器码盘上的编码有二进制和格雷码两种。采用二进制码的码盘从某一位置转到其前一位置或后一位置时会有多段弧圈发生0变为1或1变为0的变化,而采用格雷码的码盘从某一位置转到其前一位置或后一位置时则只用某一弧圈发生0变成1或1变为0的变化。3.1.2位移和角度测量传感器二进制码与格雷码3.1.3加速度传感器加速度计有两种:一种是角速度加速度计,是由陀螺仪(角速度传感器)改进的,另一种是线速度计。加速度传感器的原理随其应用而不同,有压电式加速度传感器、电容式加速度传感器、压阻式加速度传感器、谐振式加速度传感器、伺服式加速度传感器等。3.1.3加速度传感器1.压电式加速度传感器压电式加速度传感器具有体积小、功耗低等特点,易于集成在各种模拟和数字电路中。压电式加速度传感器的敏感元件有弹性梁、质量块、固定框组成。当有加速度a作用于传感器时,传感器的惯性质量块便会产生一个惯性力F作用于传感器的弹性梁上,便会产生一个正比于F的应变,此时弹性梁上的压敏电阻也会随之产生一个变化量△R,由压敏电阻组成的惠斯通电桥输出一个与△R成正比的电压信号V。3.1.3加速度传感器1.压电式加速度传感器压电式加速度传感器外形3.1.3加速度传感器2.压阻式加速度传感器压阻式加速度传感器的悬臂梁上有压敏电阻,当惯性质量块发生位移时,会引起悬臂梁的身长或压缩,改变梁上的应力分布,进而影响压敏电阻的阻值,压阻电阻多位于应力变化最明显的分布。这样,通过两个或四个压敏电阻形成的电桥就可以实现加速度的测量。3.1.3加速度传感器2.压阻式加速度传感器压阻式加速度敏感元件3.1.3加速度传感器3.光波导加速度计光波导加速度计的原理:光源从波导1进入,经过分束部分后分成两部分分别通入波导4和波导2,进入波导4的一束直接被探测器2探测,而进入波导2的一束会经过一段微小的间隙后进入波导3,最终被探测器1探测到。有加速度时,质量块会使得波导2玩去,进而导致其与波导3的正对面积减少,使探测器1探测到光减弱,通过比较两个探测器检测到的信号即可求得加速度。3.1.3加速度传感器3.光波导加速度计光波导加速度计原理3.1.3加速度传感器4.谐振式加速度计一根琴弦绷紧程度不同时弹奏出的声音频率也不同,谐振式加速度计的原理与此相同。SOA常见的结构有S结构和双端固定音叉两种。S结构原理为:若对振梁施加确定的激振,检测器响应就可测出其固有频率,进而测出加速度。激振的施加和响应的检测通常都是通过梳齿机构实现的。3.1.3加速度传感器4.谐振式加速度计谐振式加速度计原理3.1.4姿态角测量传感器陀螺仪是用高速回转体的动量矩敏感壳体相对惯性空间绕正交于自转轴的角运动检测装置,利用其他原理制成的角运动检测装置起同样功能的也称陀螺仪,基本功能是测量敏感角位移和角速度。三轴陀螺仪分别感应Roll(左右倾斜)、Pitch(前后倾斜)、Yaw(左右摇摆)的全方位动态信息。它是构成移动机器人惯性导航系统的核心敏感器件,其测量精度直接影响移动机器人姿态解算的准确性。3.1.4姿态角测量传感器陀螺仪3.2

移动机器人外部传感器3.2.1感觉传感器1.触觉感知传感器触觉传感器有开关型和阵列型两种,开关型感觉物体的存在性,阵列型感觉物体的存在和形状,还可以感觉物体的软硬程度。开关型是用于检测物体是否存在的一种简单的触觉传感器,可以通过切断/导通(即导体是否有电流)来判断是否接触。3.2.1感觉传感器1.触觉感知传感器触觉传感器是由几个接触传感器组成的阵列,而接触传感器由触杆、发光二极管和光传感器组成。当触觉传感器接近物体时,触杆将随之缩进,遮挡了发光二极管向光传感器发射的部分光线,于是光传感器输出与触感位移或压力成正比的信号。当触觉传感器与物体接触时,依据物体的形状和尺寸,不同的接触传感器将以不同的次序对接触做出不同的反应,控制器就利用此信息来确定物体的大小和形状。3.2.1感觉传感器1.触觉感知传感器触觉传感器3.2.1感觉传感器2.接近觉感知传感器接近觉传感器用来感觉是否有目标物体接近和接近的距离,包括感应式传感器、电容式传感器、光学传感器、超声波传感器等。感应式传感器要求检测的物体是金属。电容式传感器可以检测任何固体和液体,测量范围为毫米级。光学传感器主要指红外传感器和超声波传感器。感觉是否有目标物体接近一般用红外传感器,测近距一般用超声波传感器,而且也可以用在水下测量距离、方向和速度。3.2.1感觉传感器2.接近觉感知传感器红外传感器是根据波从发射到接收的传播过程中所受到的影响来检测物体的接近程度。这类传感器包括一个可以发射红外光的固态发光二极管和一个用作接收器的固态光敏二极管(或光敏三极管)。当光强超过一定程度时光敏三极管就会导通,否则截止。把发光二极管和光敏三极管汇聚在同一面上,反射光才能被接收器看到。3.2.1感觉传感器2.接近觉感知传感器红外传感器3.2.1感觉传感器2.接近觉感知传感器红外传感器中,一般采用反射光强法进行测量,即目标物对发光二极管散射光的反射光强度进行测量。光的反射系数与目标物表面颜色、粗糙度等有关。目标颜色较深、接近黑色或透明时,其反射光很弱。若以输出信号达到其一阈值作为“接近”时,则对不同目标物“接近”的距离是不同的。红外光强法接近觉对大多数目标物是能找到“接近”感觉的,即能很容易地检测出工作空间内某物体是否存在,但是作为距离的测量并不精确。3.2.2测距传感器超声波传感器发射超声波脉冲信号,测量回波的返回时间便可得知达到物体表面的距离。如果安装多个接收器,根据相位差还可以得到物体表面的倾斜状态信息。但是,超声波在空气中衰减得很快(在1MHz的条件下为12dB/cm),因此其频率无法太高。超声波传感器可测量方向、距离、速度。移动机器人主要应用超声波传感器采用主动测距方式测距。主动测距方法有渡越时间法、脉冲回波法、频率调制连续脉冲等。3.2.2测距传感器TOF方法检测超声波往返距离的时间。所用的时间与超声波通过距离成正比,记录超声波发射极发出脉冲时间和超声波接收器接收到第一个返回脉冲时间,可得到时间值T,由时间T计算出距离,TOF测量方法对噪声敏感。超声波传感器3.2.3视觉传感器1.CCD图像传感器CCD(ChargeCoupledDevice,感光耦合组件)是摄像系统中可以记录光线变化的半导体,通常以百万像素为单位。CCD相机的原理是芯片上面整齐地排列着很多小的感光单元,光线中的光子撞击每个单元后,在这些单元中会产生电子(光电效应),光子的数目与电子的数目互成比例。3.2.3视觉传感器1.CCD图像传感器CCD(ChargeCoupledDevice,感光耦合组件)是摄像系统中可以记录光线变化的半导体,通常以百万像素为单位。CCD相机的原理是芯片上面整齐地排列着很多小的感光单元,光线中的光子撞击每个单元后,在这些单元中会产生电子(光电效应),光子的数目与电子的数目互成比例。3.2.3视觉传感器1.CCD图像传感器每一个CCD组件由上百万个MOS电容所构成。当数字相机的快门开启,来自影像的光线穿过这些马赛克色块会让感光点的二氧化硅材料释放出电子〈负电〉与电洞〈正电〉。经由外部加入电压,这些电子和电洞会被转移到不同极性的另一个硅层暂存起来。电子数的多寡和曝光过程光点所接收的光量成正比。在一个影像最明亮的部位,可能有超过10万个电子被积存起来。3.2.3视觉传感器1.CCD图像传感器曝光后所有产生的电荷都被转移到邻近的移位缓存器中,并且逐次逐行的转换成信号流从矩阵中读取出来。这些电荷讯号先被送入一个QV之中将电荷转换成电压;再将电压放大进行A/D转换。ADC将信号的连续范围配合色块码赛克的分布,转换成一个2D的平面表示列,它让每个画素都有一个色调值,应用这个方法,再由点组成网格,每一个点现在都有用以表示它所接受的光量的二进制数据,可以显示强弱大小,最终再整合影像输出。3.2.3视觉传感器2.CMOS图像传感器CMOS图像传感器是一种典型的固体成像传感器,通常由像元阵列、行驱动器、列驱动器、时序控制逻辑、A/D转换器、数据总线输出接口、控制接口等几部分组成,其工作过程一般可分为复位、光电转换、积分、输出几部分。

CMOS图像传感器结构框图3.2.3视觉传感器2.CMOS图像传感器光照射像元阵列,发生光电效应,在像元内产生相应的电荷。行选择逻辑单元根据需要选通相应的行像元。行像元内的图像信号通过各自所在列的信号总线输出到对应的模拟信号处理单元以及A/D转换器,转换成数字图像信号输出。其中的行选择逻辑单元可以对像元阵列逐行扫描也可以隔行扫描,行选择逻辑单元与列选择逻辑单元配合使用可以实现图像的窗口提取功能。模拟信号处理单元的主要功能是对信号进行放大处理,提高信噪比3.2.3视觉传感器2.CMOS图像传感器由于杂质、受热等其他原因的影响,即使没有光照射到象素,象素单元也会产生电荷,这些电荷产生了暗电流。暗电流与光照产生的电荷很难进行区分。暗电流在像素阵列各处也不完全相同,它会导致图形噪声。另外,光输入信号过强的话,像素单元将饱和而不能进行光电转换,图像会模糊。3.3移动机器人视觉原理视觉对于移动机器人,就像眼睛对人一样重要,根据视觉系统所使用的摄像机数目不同,视觉系统分为单目视觉系统、双目视觉系统和多目视觉系统。在移动机器人领域,视觉主要用于环境中目标位姿测量,典型应用包括移动机器人视觉定位、目标跟踪、视觉避障等。3.3.1摄像机成像模型1.参考坐标系3.3.1摄像机成像模型1.参考坐标系(1)世界坐标系将世界坐标系表示成

,此坐标系描述空间中各个目标的位置。其原点和各个坐标轴可以由人为自行定义,通常将机器人的基坐标系作为世界坐标系。(2)摄像机坐标系摄像机坐标系

是以摄像机光心为原点设立的三维直角坐标系,Zc轴即摄像机光轴,正方向为摄像机指向景象的方向,垂直于成像面。

为摄像机的焦距f。3.3.1摄像机成像模型1.参考坐标系(3)图像物理坐标系目标物体经由摄像机采集图像,将像点投影到成像平面上,称光轴与成像平面的垂直交点为图像主点

,以主点为原点建立图像物理坐标系

,其横轴

和纵轴

分别平行于摄像机坐标系横轴Xc和纵轴Yc,则物理坐标(x,y)代表空间中一点在成像平面上的投影点坐标。3.3.1摄像机成像模型1.参考坐标系(4)图像像素坐标系用摄像机采集图像,图像信息是模拟的,经过图像采集卡的处理转变为数字信号。在计算机中数字图像的表达形式是M×N二维数组,数组里的元素代表图像像素点,元素值即为像素值,代表图像亮度。在图像上建立图像像素坐标系

,原点为图像左上角点,横轴的正方向水平向右,纵轴垂直于向下,单位是像素,像素坐标代表了该像素在二维图像数组位于第U列、第V行。3.3.1摄像机成像模型1.参考坐标系(4)图像像素坐标系假定主点

的像素坐标是

轴和

轴相对于U轴和V轴的尺度因子依次为dx和dy,那么像素坐标系和图像物理坐标系的关系可以下式表示:式中(u,ν)表示物点像素坐标系坐标,(x,y)表示物点物理坐标系坐标。3.3.1摄像机成像模型1.参考坐标系用齐次坐标与矩阵来表示上式则为:2.摄像机针孔模型光线照射到物体上发生反射,经由摄像机中心(针孔)投影到成像平面上,感光元件将采集到的光信号转变为电信号,最终形成数字图像。变换图形方向即可使其与景物方向一致。3.3.1摄像机成像模型2.摄像机针孔模型针孔模型3.3.1摄像机成像模型2.摄像机针孔模型点P在摄像机坐标系下的坐标为(xc,yc,zc),

点在图像物理坐标系下的坐标为(x,y),直线OcOβ的模为摄像机焦距f,由三角形相似原理可知:3.3.1摄像机成像模型3.摄像机内参模型在摄像机内部,物点在摄像机坐标系

下的坐标映射到图像像素坐标系

,在摄像机外部,物点在世界坐标系

下的坐标映射到摄像机坐标系

。物点由三维空间映射到成像平面的像点是失真的,成像平面上的像点对应的是起点为光心且经过该像点的射线。得到摄像机坐标系和像素坐标系之间的关系,如下:3.3.1摄像机成像模型3.摄像机内参模型令

,用齐次坐标和矩阵来表示,如下:3.3.1摄像机成像模型4.摄像机外参模型摄像机外参模型描述的是摄像机坐标系和世界坐标系的映射关系,用其次坐标和矩阵可表示为:(xc,yc,zc)表示景物点在摄像机坐标系中坐标;(xw,yw,zw)表示景物点在世界坐标系下的坐标;

为摄像机外参矩阵3.3.2双目视觉原理模型1.平行双目视觉模型平行双目视觉模型3.3.2双目视觉原理模型1.平行双目视觉模型在平行双目视觉模型中,2个摄像机的光轴平行,X轴在一条直线上且所指方向一致。左摄像机坐标系的原点为Ocl,X轴为Xcl;右摄像机坐标系的原点为Ocr,轴为Xcr;将左右摄像机光心连线OclOcr称为基线,其长度为b;物点p在左右摄像机坐标系下的坐标分别为和;物点在左右摄像机内部的图像像素坐标系下的坐标为(ul,vl)和(ur,vr)。设左右摄像机的焦距为f,旋转矩阵R是单位矩阵,平移矩阵

,根据三角形相似原理可知:3.3.2双目视觉原理模型1.平行双目视觉模型因此,物点p在左摄像机坐标系下的坐标可以解出:3.3.2双目视觉原理模型2.一般双目视觉模型一般双目视觉模型3.3.2双目视觉原理模型2.一般双目视觉模型在左摄像机中可以确定物点p在射线Oclpl上,在右摄像机中可以确定物点p在射线Ocrpr上,则射线Oclpl和射线Ocrpr的交点p点。同平行双目视觉模型,设p点在世界坐标系下的坐标为(xw,yw,zw),左右摄像机的投影矩阵为L和

,可以得到p点世界坐标和图像像素坐标之间的关系:3.3.2双目视觉原理模型2.一般双目视觉模型3.3.3摄像机标定摄像机标定方法可分为三类:传统的摄像机标定方法,主动视觉摄像机标定方法和摄像机自标定方法。传统的摄像机标定方法可以使用于任意的摄像机模型,精度很高,但不可以用在无法使用标定块的环境下。主动视觉摄像机标定方法对标定环境的要求高,不能使用于摄像机运动未知的场合,且精度较低;摄像机自标定方法不能非线性标定,鲁棒性不高。Faugeras的标定方法作为传统的摄像机标定方法不仅算法实现简单,而且可线性求解参数。3.3.3摄像机标定Faugeras标定方法选用4参数内参矩阵,将像点和物点的成像几何关系在齐次坐标下写成透视投影矩阵的形式:3.3.3摄像机标定每个点可以得到两个方程,而未知数只有11个,所以,最少取六个点即可通过最小二乘法求出

,其中移动机器人技术原理与应用第四章

移动机器人定位移动机器人绝对定位移动机器人视觉定位4.1移动机器人相对定位4.24.3移动机器人概率定位4.44.1移动机器人相对定位相对定位是指通过度量移动机器人相对于起始位置的方向和距离来推断出移动机器人当前的位置信息。其基本原理是在移动机器人位姿初始值给定的前提下,基于内部传感器信息计算出每一时刻位姿相对于上一时刻位姿的距离以及方向角的变化,从而实现位姿的实时估计。常用的传感器包括光电编码器及惯性导航系统,因此,应用此类传感器进行相对定位的方法也通常称为航迹推算法和惯性导航法,相对定位也叫做位姿跟踪。4.1.1航迹推算法原理应用航迹推算法定位的轮式移动机器人,通常在驱动轮上安装光电编码器来测量轮子的旋转角度,再结合移动机器人本身的结构和运动特性计算出移动机器人相对于初始点的方向和位置,从而确定出位姿信息。航迹推算是个累加的过程,在移动机器人运动而航迹逐步累加的过程中,移动机器人位姿信息的测量值以及计算值均会有累积误差,定位精度会下降,因此,航迹推算法适用于短时间或者短距离的移动机器人位姿跟踪。4.1.1航迹推算法原理若双轮差动移动机器人在出发的初始时刻,移动机器人自身坐标与世界坐标重合,经过运动时间t后,移动机器人从原点运动到目标点P。设此时移动机器人在世界坐标系中的位置为P(Xt,Yt),移动机器人坐标系的x轴与世界坐标X轴的夹角为θt。设l为两轮间距,Δt为编码器计时间隔时间,则在相同的一个采样周期Δt内,移动机器人转过的角度为:4.1.1航迹推算法原理其中,VL、VR为移动机器人的左、右轮速度。在一个采样周期Δt内,移动机器人行走的距离为:该两轮移动机器人的平均速度

表示为:在Δt时间间隔内,移动机器人的位置变化表示为:4.1.1航迹推算法原理在t时刻后的t+Δt时刻,移动机器人位置信息可表示为:对于长时间的运动,航迹推算法存在累积误差,此类误差来源于移动机器人安装的陀螺仪、加速度计和倾斜角传感器产生的漂移误差,此类误差可以通过建立误差模型进行补偿,也可以应用航迹推算法和其他的传感器配合相关的定位算法进行校正。4.1.2移动机器人里程计定位在双轮差动移动机器结构中,里程计的工作原理是根据安装在移动机器人左右两个驱动轮电机上的光电编码器来检测车轮在一定时间内转过的弧度,进而推算移动机器人相对位姿的变化。将光电编码器与驱动轮同轴安装,实现光电编码器与驱动轮同步旋转。根据码盘分辨率、驱动轮上驱动电机和减速器的变速比、驱动轮的直径等物理参数,将驱动脉冲数转换成驱动轮旋转的角度和位移,即移动机器人相对于某一参考点的瞬时位置,就是里程计。4.1.2移动机器人里程计定位若码盘分辨率Cm、驱动电机和减速器的变速比n、驱动轮的直径D,则每个脉冲对应的移动机器人车轮圆周上的距离为:在一个单位时间内,若左、右轮的脉冲数Nl、Nr已知,则可确定左右轮的速度分别为:根据一个采样周期Δt内脉冲数算出移动机器人转过的角度和行走的距离,即里程计的数值,获得移动机器人位姿。4.1.2移动机器人里程计定位1.差动轮式移动机器人直线定位若差动轮式移动机器人左右驱动轮的运动方向、速度都相同,则机器人沿直线运动直线定位原理图4.1.2移动机器人里程计定位1.差动轮式移动机器人直线定位机器人在Pi+1点的位姿为:di为光电码盘测得的机器人行驶路程,用左、右轮分别测得的行驶路程的算术平均值计算。4.1.2移动机器人里程计定位2.差动轮式移动机器人机器人旋转定位若差动轮式移动机器人左、右驱动轮的运动方向相反但速度相同,则移动机器人在原地旋转运动旋转运动定位原理图4.1.2移动机器人里程计定位2.差动轮式移动机器人机器人旋转定位两轮转动的角度为:d为车轮行驶里程。机器人在Pi+1点的位姿方向角为:4.1.3移动机器人惯性导航法定位惯性导航法通常指采用陀螺仪和加速度计实现定位。根据陀螺仪和加速度计分别测得移动机器人的回转速度和加速度,利用一次积分和二次积分求出角度和位置参量。陀螺仪通过对所测量的角度和速度进行积分,计算出相对于起始方向的偏转角度。δ为t时刻相对起始方向的偏转角度;ω为瞬时角速度;t0为起始时间。4.1.3移动机器人惯性导航法定位基于光电编码器的里程计定位和基于陀螺仪和加速度计的惯性导航法定位方法中,都存在不可避免的误差。对于常见的轮式移动机器人来说,通常将误差源分为两大类:系统误差和非系统误差。其中系统误差包括:车轮半径不相等、车轮半径均值与标称轮半径不等、车轮不平行、有效轮距未知、传感器分辨率有限、传感器采样频率有限。非系统误差包括:行驶的地面不平坦、地面有不可预知的物体、由于有些原因导致车轮行驶过程当中的打滑(光滑的地面、加速度过大、急速转弯、外界的作用力等)。4.2移动机器人绝对定位绝对定位能确定移动机器人在全局参考框架下的位姿信息,不依赖于时间和初始位姿,因此,不但没有累积误差问题,而且还具有精度高、可靠性强等特点。基于信标的定位、基于地图匹配方法的定位以及基于卫星的定位都属于绝对定位方法的范畴。从传感器角度,基于红外、超声波、激光、以及相机的定位都属于绝对定位。从技术手段上,伪卫星、Wi-Fi、射频标签(RFID)、蓝牙(Bluetooth,BT)、超宽带(UltraWideBand,UWB)、地磁以及光跟踪等,也属于绝对定位范围。4.2.1BDS定位中国北斗卫星导航系统(BeiDouNavigationSatelliteSystem,BDS)是中国自行研制的全球卫星导航系统,采用三球交汇定位原理进行定位。在空间中已知A、B、C三点的位置,待定位移动机器人看作质点D,D点到上述三点的距离皆已知的情况下,可以确定出移动机器人D的空间位置,D点一定位于分别以A、B、C为圆心,AD、BD和CD为半径的三个圆球的交汇点上。中国北斗卫星导航系统分为三个部分,分别为空间段、地面段、用户段。4.2.1BDS定位空间段:北斗卫星导航系统的空间段计划由35颗卫星组成,包括5颗静止轨道卫星、27颗中地球轨道卫星、3颗倾斜同步轨道卫星。5颗静止轨道卫星定点位置为东经58.75°、80°、110.5°、140°、160°,中地球轨道卫星运行在3个轨道面上,轨道面之间为相隔120°均匀分布。地面段:由中心控制系统和标校系统组成。中心控制系统主要用于卫星轨道的确定、电离层校正、用户位置确定、用户短报文信息交换等。标校系统可提供距离观测量和校正参数。系统的地面段由主控站、注入站、监测站组成。4.2.1BDS定位主控站用于系统运行管理与控制等。主控站从监测站接收数据并进行处理,生成卫星导航电文和差分完好性信息,而后交由注入站执行信息的发送。注入站用于向卫星发送信号,对卫星进行控制管理,在接受主控站的调度后,将卫星导航电文和差分完好性信息向卫星发送。监测站用于接收卫星的信号,并发送给主控站,可实现对卫星的监测,以确定卫星轨道,并为时间同步提供观测资料。4.2.1BDS定位用户段:用户段即用户的终端,既可以是专用于北斗卫星导航系统的信号接收机,也可以是同时兼容其他卫星导航系统的接收机。接收机需要捕获并跟踪卫星的信号,根据数据按一定的方式进行定位计算,最终得到用户的经纬度、高度、速度、时间等信息。移动机器人控制系统中应用北斗卫星导航系统用户端软硬件,即可以实现绝对定位。4.2.2GPS定位GPS导航系统是以全球24颗定位人造卫星为基础,向全球各地全天候地提供三维位置、三维速度等信息的一种导航定位系统。该系统卫星分布在6个轨道面上,在地球表面的任何地域,任何时间都可以至少同步接收4颗以上的卫星信号。GPS不断向地面发送导航电文,地面上任何位置就可以根据4颗卫星信道的电文信息推算出当前接收者的三维位置,实现导航定位目的。GPS定位系统由三部分构成,一是空间部分;二是地面控制部分;三是用户装置部分。4.2.2GPS定位空间部分:GPS定位系统的空间部分是由24颗GPS工作卫星所组成,这些GPS工作卫星共同组成GPS卫星星座,其中21颗为可用于导航的卫星,3颗为备用卫星。这24颗卫星分布在6个倾角为55°的轨道上绕地球运行,卫星的运行周期约为12恒星时。每颗GPS工作卫星都发出用于导航定位的信号,GPS用户正是利用这些信号来进行工作的。4.2.2GPS定位地面控制部分:由分布在全球的由若干个跟踪站所组成的监控系统所构成。根据其作用的不同,这些跟踪站又被分为主控站、监控站和注入站。主控站的作用是根据各监控站对GPS的观测数据,计算出卫星的星历和卫星钟的改正参数等,并将这些数据通过注入站注入到卫星中去,同时,它还对卫星进行控制,向卫星发布指令,当工作卫星出现故障时调度备用卫星,替代失效的工作卫星工作;另外,主控站也具有监控站的功能;注入站的作用是将主控站计算出的卫星星历和卫星钟的改正数等注入到卫星中去。4.2.2GPS定位用户部分:由GPS接收机、数据处理软件及相应的用户设备如计算机气象仪器等所组成。它的作用是接收GPS卫星所发出的信号,利用这些信号进行导航定位等工作。4.2.3路标定位路标是指具有明显特征而能够被移动机器人传感器识别的特殊物体,路标有人工路标和自然路标两种类型,人工路标就是专门设计的物体或者标识物,只具有给机器人导航的唯一应用;自然路标是一些物体或者特征,除导航外,还具有其他功能。移动机器人定位的主要任务就是应用路标观测的传感器如超声波传感器、激光雷达、视觉传感器等可靠地辨识路标,并据此计算出移动机器人的位置。位精度的高低取决于对路标的识别以及位置信息提取的准确程度。4.2.3路标定位三边定位测量法是根据移动机器人与路标之间的距离来确定移动机器人位置的方法。三边测量定位系统至少需要将3个已知位置的信号发射器(或者接收器),而接收器(或者发射器)安装在移动机器人上。在三边测量法导航系统中,有三个以上在环境中已知的固定地点,移动机器人根据这些固定点的距离,应用几何三角学确定自身在已知坐标系中的坐标。测距方法采用时间—路程计算方法,根据超声波发射波传播时间,系统可以计算固定点的发射器与移动机器人上接收器之间的距离。4.2.3路标定位三边测量法示意图4.2.3路标定位R(x0,y0)为移动机器人当前位置,S1、S2、S3分别为三个固定位置,已知移动机器人到三点S1、S2、S3的距离I1、I2和I3,以I1,I2,I3

为半径作三个圆,根据毕达哥拉斯定理,可得出交点即未知点R(x0,y0)的位置计算公式方程组如下:求解方程,即可得到移动机器人当前位置R(x0,y0)的值。4.2.3路

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

最新文档

评论

0/150

提交评论