室内激光雷达导航系统设计.pdf

位置,地标,导航系统,技术,测量,其他资料
文档页数:6
文档大小:685.87KB
文档格式:pdf
文档分类:其他资料
上传会员:
上传日期:
最后更新:

室内激光雷达导航系统设计

史风栋,刘文略,注鑫”,丁娟,史屹君,修春波

(1.天津工业大学工程教学实习训练中心,天津300387;

摘要:小型无人机和移动机器人技术迅速发展,对室内导航技术的要求越来越高,针对当前室内导航精度不高、导航设备比较复杂的问题,提出一种采用激光需达定位和地磁传感器检测相结合的室内 主动导航方法.该方法首先使用激光雷达扫描室内环境,用来集到的数据拟合出室内地图,根据目的地信息和室内的环境信息来规划行进的路线:然后在行进中使用激光雷达连续地担描得到数据与地图数据进行比较,来确定所处的位置,同时使用地磁传感器取得行驶的方向,二者相结合判断是否在规划的路线上行驶,及时地对出现的偏差进行纠正:最后通过搜索RFID地标确定是否已经到达指定足室内导航的要权. 住置.仿真和实验的结果表明:所设计的室内激光雷达导航系统结构简单、可靠性高,能够较好地满

关键词:激光富达:室内导航:地磁传感器:RFID

中图分类号:TP23文献标志码:A文章编号:1007-2276(2015)12-3570-06

Designofindoorlaserradarnavigation system

xsun xo

2. Tiaejn Zhonghuan Innovstion Sctience and Teceology Co. LTD Tianjin 300190 China;3. Tianjin Jinhang Institue of Technical Physics Tianjin 300308 China)

Abstract: With the rapid development of micro aerial vehicle technology and mobile robots technology the requirements for indoor navigation technology are being higher and higher but navigationpresence is low and equipment is relatively plex in indoor navigation system. To address thissensors measurement was proposed. First laser radar was used to scan the indoor environment the map be constructed by collected data the route be planed based on the destination information and the indoorenvironment information; and then the data which was obtained by laser radar continuously scanningcnvironment was pared with the map data when the vehicle was traveling the location wasdetermined direction of travel was obtained by geomagnetic sensor whether the vehicle was on the rightroad was determined by the bination of position and direction of travel the deviation will be corrected in time; last whether arriving at designated location was determined by searching RFID

landmarks. Simulation and experimental results show that the indoor Iaser radar navigation system is simple and the reliability is high which meet the requirements of indoor navigation.

Key words: laser radar;indoor navigation; geomagnetic sensor;RFID

并针对室内导航进行设计,将会取得较好的效果.下 面以仓储车间的无人驾驶货运小车为例分析室内激光需达导航系统的工作原理和过程.

0引言

室内导航技术是近些年来兴起的一个热点技术,它在工业生产和日常生活中都有非常重要的用途,例如:仓储车间中的无人驾驶货运小车、他险环境中的探测机器人、室内飞行的小型无人机等都需要借助室内导航技术来工作D-2随看GPS的不断发 展和北斗卫星定位系统的进一步完着,导航系统在导航精度和降低成本上都有很大的提高,但是它们正常工作的前提是能够搜索到足够多的卫星信号,所以一般局限于室外,面室内的导航和定位技术远没有室外完善.目前室内导航技术主要包括室内 WIFI定位、LBS基站定位、惯性导航、基于摄像机的视觉导航和以环境磁场为基础的室内定位技术.这些方法都有各自的特点,也取得了不错的效果,但是由于方法自身存在的一些限制,需要进一步地改进和提高才在实际中更好地应用,例如:室内WIFI定位技术是根据无线信号的强弱来实现定位的,需 要预先安装无线传感器,并进行大量的测试,工作量大;LBS基站定位技术是基于运营商网络面获取移动终竭用户的位置信息,方便快捷,但是定位精度差:惯性导航是利用加速度计与陀螺仅计算航程、推知当前位置和下一步目的,但随着航程的增长定位 误差将不断累加,导致定位精度下降,而且设备比较复杂,成本较高":视觉导航系统能够较好地采集前方障碍物的距离信息和运动信息,但运算量较大、容易受到环境的影响,且以被动导航为主":以理设磁轨道为基础的电磁导航技术简单实用,但铺设和施 工的成本高,改造和维护图难;IndoorAlas公司推出的以地磁场构建室内地围的方法还处于理论研究阶段,在技术实现上比较复杂,没有正式应用.

1室内激光雷达导航原理

激光雷达是传统雷达与激光技术相结合的产物,是以微波雷达原理为基础,将激光束作为探测信 号.激光雷达工作时,首先发射机发射一束特定功率的激光束,经过大气传输辐射到目标表面上,反射的回波由接收装置接收,再对回波信号进行处理,提取有用的信息.通过测量反射和散射回波信号的时间间隔、频率变化、波束所指方向等就可以确定目标 的距离、方位和速度等信息*.

利用激光雷达实现室内导航的原理:首先使用激光雷达对室内的区城进行光探测,得到周围庵码物距离探测点的相对坐标,然后构建以探测点为中心、以雷达扫播半径为最大区域的环境地图;最后在车辆行驶过程中连续使用新光雷达进行探测,得 到以当前位置为中心的环境信息,与地图中的特征点对比后可以确定车辆在地图中所处的位置,从而达到导航的目的0-1.

2室内激光雷达导航系统

2.1室内导航系统构建

室内激光导航技术是在分所室内定位和室内导航特点的基础上,将激光雷达技术从室外引人到室内的一种导航方法.针对仓储车间无人驾驶货运小车设计的激光雷达导航系统原理如图1所示.

通过对室内导航特点和当前室内导航技术的分析,提出采用激光雷达扫描环境定位为主、地磁传感器检测行驶角度为辅的室内主动导航技术.激光雷 达在室外的定位导航应用中有非常好的表现,地磁传感器在行驶角度测量方面比较成熟,将二者结合

图1室内激光霞达导能系统原理概图

Rig.1 Schematic diagram of iadoor lase: radar navigstion syitem

由微处理器控制激光发射器向四周发射激光束探测周围环境,同时接收反射回来的激光信号,经过信号分析得知周围的环境信息,据此规划出到达某一前进的方向,并根据行进过程中得到的环境信息来确 地点的行驶路线.在行进过程中使用地磁传感器测量定是否在规划的路线上行驶,如果偏离,能及时地做出调整,最终到达目的地.RFID阅读器不断地扫描周围是否有RFID路标,扫描到的路标中包含车辆行驶的地.试验用的无人驾驶小车如图2所示. 所需的关键点的位置信息,能辅助小车到达最终的目

Fig.3 Measrememt model of laser radar 图3激光雪达测量模型

激光雷达360扫描周围的环境,得到周图环境的信息,图4是激光雷达探测某仓储车间局部信息的示意图,经过激光束的发送和接收得到障碍物到雷达中心的距离.

图2试输用的无人驾驶小车Fig.2 Experimemtal usmanoed car

2.2激光雷达数据获取

激光雷达能以较高的频率扫植一个平面或空间运动物体进行实时定位回.仓储车间的环境相对简 内的环境信息,室内导航系统能够利用这些信息对单,物品摆放比较整齐,为了减少数据量和提高数据处理效率,采用单线激光雷达来进行扫描,使微处理器缩短数据处理时间.

图4散光需达探测示意用

Fig.4 Schematic diagnm of laser adar detectios

2.3环境地图拟合

激光雷达扫措周围环境,得到环境中境壁、货物等障碍物到激光雷达中心的距离数据,由这些数据 组成离散的室内环境轮房图,如图5所示.图中既有墙壁、货架等连续性较强的点,又有比较零散的货物的点,例如图5下方有三处零敢放置的物体,左上角靠近墙角处也有零星的余物,这些物体虽然连续性不是很强,但是在制作环境信息地图时要按照一个 整体考虑,这样便于规划车辆行驶的路线.

好,但成本很高,室内载物小车上使用的激光雷达 用于室外的激光雷达探测距离远,性能比较在成本方面要适当降低.工厂仓储车间的面积一般不会很大,面积以1000m²左右的居多,从成本和实用角度出发在室内导航系统设计时采用探测半2000点/s、每秒扫描2周,即0.5s扫描一个平面的 径最大为15m的激光雷达.该激光雷达扫描题率数据为1000个.

激光需达的输出原始数据是以激光雷达为中心针依次扫播,得到的数据用(d.6)表示,d为反射点到 坐标系的极坐标数据点,如图3所示,激光雷达道时激光雷达中心的直线距离,6为反射点到激光雷达中心与起始扫描点之间的夹角,激光雷达扫描角分辨率为0.36°,极坐标角度与采样点位置的关系为:

图5高意的室内环境轮靠图

100T~[=}²90(1-7)=g

Fig.5 Disxrete outine of the indoor envircement

要想得到连续的环境信息,还需要对离散的数据进行差补等拟合算法的处理,常用的拟合算法有最小二乘法、最小绝对残差法和Bisquare方法.最小二乘法是通过最小化误差的平方和导找数据的最佳 函数匹配,利用最小二乘法可以简便地求得未知的数据,并使得这些求得的数据与实际数据之间误差的平方和为最小.按偏差平方和最小的原则选取拟合曲线,并且采取二项式方程为拟合曲线的方法称为最小二乘法拟合方法.最小二乘法原理的表达 式为:

相对于最小绝对残差法是和Bisquare方法最小二乘法更加简便,并能够满足室内环境的距离数据相比直线路线虽然路程稍长,但更容易平稳地行驶 拟合的需求.局部环境的数据经过最小二乘法报合后得到如图6所示的轮廊图.

整体的环境信息是将拟合后的局部轮廊连接在实现室内导航的基础.

图7拟合后周围环境轮案图Fig.7 Fimed environmental outine

2.4根据环境地图规划行驶路线

的特征点和货运小车的目的地规划出行驶路线.路数据可由IC或者SPI数字接口输出,方便快捷.使用

线的规划不仅要考虑是否走得通,还要考虑是否适合货运小车载货后通行方便、综合以上因素考虑,在设计行驶路线时不能简单地采用距离最短的路径,架等)进行设计,这样小车在行驶过程中的参照物相 面是选择靠近形状比较规则的障碍物(例如墙壁、货对固定,路线也比较规则,偏差距离更容易控制,行驶起来就会顺畅.货运小车的实际运动轨遍与理论上存在一定的差距,需要根据实际情况不断地修正.例如运动方向、运动速度、载货后的质量等,所以设 计出的行进路线不能仅仅是-一条线,面是以行进路线为中心线的行驶区城.

图8所示的行驶路线靠近环境的外轮那,是充分考惠了货运小车的实际行驶的过程面设计出的,和绕开障碍物.规划中以A区域的Start为起始位置,在B区域进行装货操作,最终到达目的地C.

一起得到的,图7是拟合后的周围环境轮图,这是3物料运输车的运动控制

3.1地磁传感器运动角度测量

地磁传感器是采用法拉第电磁感应定律,利用被测物体在地磁场中的运动状态不间,通过感应地磁场的分布变化面指示被测物体的姿势和运动角度等信息的测量装置.地磁传感器能够测出轴方向上 的地磁场强度,由三角公式可以计算出传感器量测轴与磁场方向之间的角度.利用地磁传感器可以制作电子指南针,在导航特别是盲区导航中有很重要的作用,在室内导航系统中使用地磁传感器来测量车辆的行驶角度,为车辆导航抵供信息.

得到拟合后的环境地图之后,可以根据地图中高精度三轴磁场传感器,角度测量精度最高可达1°, 在系统中选用霍尼韦尔公司生产的HMC5983型

地磁传感器测量角度的原理与使用激光雷达测量角度的原理不同,使用两种方法测量可以实现结果的相互补充和参考,二者共同作用可以提高测量精度.

3.2运输车实时定位与运动控制

货运小车的运动控制方案要与行进区城相适应,并能够根据载货情况调整运动速度和运动方向.货运小车是否在所设计的路线上行驶,当前的运动方向和速度是否满足在运动区城内行驶的条件,这些都要求实时知晓货运小车所处的位置,这就是主 动导航中的实时定位.

货运小车的车载激光雷达在行驶过程中连续探测,取得数据后与环境地图对比,可以得到在地图中的相对位置:用地磁传感器可以测量出车辆行驶的角度,由于行驶速度和时间也可以测得,所以能够得 到与之前所处地点的相对位置:二者结合就可以得到比较准确的位置.根据位置的变化和车辆行驶角度能够判断出该车是否能够在所设计的路线上正常行驶,如果有偏差,使用PID运动控制方法来调节小车的运动速度和运动方向,使之在正确的区域上行 驶.图9是货运小车根据PID理论的运动控制示意图,展示了运动方向的调节过程.

59 PD运动控制示意图

Fig.9 Schematic of motion coetrol bised on PID

3.3RFID地标信息获取

在室内导航系统中使用RFID电子标签作为地标,地标中包含重要的位置信息,可能与货运小车的 前进方向相关,也可能是指示最终目的地的信息.RFID(无线射频识别技术)是一种非接触式的信息自动获取技术,利用无线电信号空间耦合原理自动获取电子标签的信息,操作快捷方便,适合各种恶劣环境下的信息采集.

物的仓储位置、车辆指定停放的位置和在某些地点 室内导航系统中的RFID电子地标用来存储货的方向指示等信息.车辆在行驶中使用车载RFID阅

4系统软件设计

5结论

读器不断扫描周围的电子地标,由于筒读器的扫描范围有限(约为0.3m),所以当扫描到目的地的地标时就可以认为已经到达了目的地.RFID电子地标的 作用是辅助激光雷达进行室内导航的工作.

室内导航系统的软件部分主要包括:室内地图构建、激光雷达测距定位、地磁传感器测量角度、RFID地标读取和车辆行驶控制等部分,并能够通过 ZigBec无线传输模块与控制端进行信息交互,具体的流程如图10所示.

Fig.10 Flow chart of the system software 图10系统软件流程图

激光雷达数据获取与处理部分是导航系统的核心部分,数据处理的工作量比较大,所以采用处理速度快和处理能力较强的32位微处理器为硬件核心,保证系统良好地运行.

室内导航技术相对于室外以卫星定位为基础导航技术还不是很成熟,各种原理的导航方法仍然在研究当中,对比目前正在研究或使用中的导航方法,以激光雷达为核心的导航方法是将在室外定位导航型化和设备成本上进行有针对性地设计,使之在室 中成熟应用的激光雷达导航方法移植到室内,在小内环境扫描、地图构建和室内定位方面有比较好的

资源链接请先登录(扫码可直接登录、免注册)
①本文档内容版权归属内容提供方。如果您对本资料有版权申诉,请及时联系我方进行处理(联系方式详见页脚)。
②由于网络或浏览器兼容性等问题导致下载失败,请加客服微信处理(详见下载弹窗提示),感谢理解。
③本资料由其他用户上传,本站不保证质量、数量等令人满意,若存在资料虚假不完整,请及时联系客服投诉处理。
④本站仅收取资料上传人设置的下载费中的一部分分成,用以平摊存储及运营成本。本站仅为用户提供资料分享平台,且会员之间资料免费共享(平台无费用分成),不提供其他经营性业务。
投稿会员:匿名用户
我的头像

您必须才能评论!

手机扫码、免注册、直接登录

 注意:QQ登录支持手机端浏览器一键登录及扫码登录
微信仅支持手机扫码一键登录

账号密码登录(仅适用于原老用户)