专利名称：一种ins辅助的室内移动机器人无线定位方法
技术领域：
本发明涉及一种INS辅助的室内移动机器人无线定位方法，属于机器人无线定位技术领域。
背景技术：
近年来，随着计算机技术、信息技术、通讯技术、微电子技术和机器人技术的飞速发展，移动机器人技术的研究与应用取得了长足的进步，使其在许多场合被寄予了替代人类自动执行某些日常性与危险性任务的厚望，如物流仓储的搬运机器人，恶劣工作环境的生产机器人等。机器人的导航与定位作为实现机器人智能化和完全自主化的关键技术，逐渐成为目前该领域的研究热点。然而，在外界无线电信号微弱、电磁干扰强烈等一系列复杂室内环境中，对智能移动机器人导航信息获取的准确性、实时性及鲁棒性有很大的影响。如何将室内环境下获取的有限信息进行有效的融合以满足智能移动机器人高导航精度的要求，消除外界环境的影响，具有重要的科学理论意义和实际应用价值。与面向室外的移动机器人相比，在室内环境下，由于受到多路径传播干扰的影响，对于移动机器人的定位与研究仍旧处于起步阶段。近年来，无线传感器网络(WirelessSensors Network, WSN)以其低成本、低功耗和低系统复杂度的特点在短距离局部定位领域表现出很大的潜力，伴随着智能化城市建设步伐的不断迈进以及全国范围内无线网络的普及和使用，许多学者开始将WSN应用于面向室内环境下的智能移动机器人的导航。目前无线定位技术主要是通过测量未知节点和已知节点之间的一个或几个无线信道物理参数来完成，例如，S.J.Kim等人利用二维超声波定位实现了室内移动机器人的自定位算法，N.Patwari 等米用测量 TOA (Time Of Arrival)和 RSS (Received Signal Strength)相结合的方式来预估节点之间的相对位置。Alsindi等研究基于TOA室内多径环境的超宽带无线定位模型和算法。IEEE 802.11无线网络(WiFi)由于目前广泛应用于室内网络通信部署，很多学者研究利用其通信参数实现室内定位，但由于其定位精度在米级，对于实现高精度室内定位还有很多工作要做。在无线定位传感器的选择上，由于超声波传感具有低功耗、低成本、高精度等特点，相对于激光测距传感、视觉传感等更得到室内机器人定位和导航研究领域专家学者的认可，如，Minami等采用分布式定位方案，利用基于TOA的多点超声波测距实现定位。Μ.M.Saad等最近提出一种无需参考节点(射频信号和定时参考)的室内超声波定位方案，采用AOA (Angle of Arrival)和T0F(Time of Flight)混合的方式实现高精度信标定位。与传统的定位方式相比，除了具有低成本、低功耗和低系统复杂度的特点之外，WSN还能够自主完成网络的组建，更加适合室内移动机器人的定位。但由于WSN采用的通信技术通常为短距离无线通信技术(如ZigBee、WiFi等)，因此若想完成长距离、大范围的室内目标跟踪定位，需要大量的网络节点共同完成，这必将引入网络组织结构优化设计、多节点多簇网络协同通信与定位等一系列问题。微惯性导航系统(MEMS inertial navigation system, MINS)具有全自主、运动信息全面、短时、高精度的优点，虽然可以实现自主导航，但误差随时间积累，长航时运行条件下将导致导航精度严重下降。
发明内容
为了解决上述问题，本发明提出了一种INS辅助的室内移动机器人无线定位方法，提高了 INS定位的精度，同时在减少WSN网络规模的基础上扩大了室内机器人定位的范围。本发明为解决其技术问题采用如下技术方案:
一种INS辅助的室内移动机器人无线定位方法，包括下列步骤:
(1)将机器人导航过程分为培训阶段和预估阶段两部分，将有WSN信号的导航过程称为培训阶段，而只有INS信号的区域称之为预估阶段；
(2)在培训阶段，是在本地相对坐标系中将INS、WSN进行集成，通过扩展卡尔曼滤波对得到的同步导航数据在导航计算机中进行数据融合，将每个时刻通过INS测量得到的东向和北向的位置、通过测速计测量得到的速度和每一时刻WSN各自测量的未知节点与参考节点之间的距离输入到扩展卡尔曼滤波器中进行滤波，最后得到每个时刻东向和北向两个方向的位置和速度预估；
(3)扩展卡尔曼滤波器的系统方程以INS每一时刻东向和北向两个方向的位置和速度作为状态变量，以每一时刻WSN各自测量的未知节点与参考节点之间的距离，测速计测量得到的速度作为观测量，INS中的加速度计测量得到的每个时刻东向和北向的加速度信息作为系统的扰动输入，系统方程如式(I)所示:
权利要求
1.一种INS辅助的室内移动机器人无线定位方法，其特征在于，包括下列步骤: (1)将机器人的导航过程分为培训阶段和预估阶段两部分，将有WSN信号的导航过程称为培训阶段，而只有INS信号的区域称之为预估阶段； (2)在培训阶段，是在本地相对坐标系中将INS、WSN进行集成，通过扩展卡尔曼滤波对得到的同步导航数据在导航计算机中进行数据融合，将每个时刻通过INS测量得到的东向和北向的位置、通过测速计测量得到的速度和每一时刻WSN各自测量的未知节点与参考节点之间的距离输入到扩展卡尔曼滤波器中进行滤波，最后得到每个时刻东向和北向两个方向的位置和速度预估； (3)扩展卡尔曼滤波器的系统方程以INS每一时刻东向和北向两个方向的位置和速度作为状态变量，以每一时刻WSN各自测量的未知节点与参考节点之间的距离，测速计测量得到的速度作为观测量，INS中的加速度计测量得到的每个时刻东向和北向的加速度信息作为系统的扰动输入，系统方程如式(I)所示:
全文摘要
本发明公开了一种INS辅助的室内移动机器人无线定位方法，属于机器人无线定位技术领域。该定位方法分为培训阶段和预估阶段两部分。培训阶段是在本地相对坐标系中将INS(惯性导航系统)、WSN(无线传感器网络)进行集成。通过扩展卡尔曼滤波对得到的同步导航数据进行数据融合，得到持续稳定的导航信息。预估阶段是将INS测量得到的位置和速度信息输入培训阶段通过神经网络培训的INS误差模型进行误差补偿，以得到最优的导航信息。本发明的方法提高了INS定位的精度，同时在减少WSN网络规模的基础上扩大了室内机器人定位的范围。
文档编号G01C21/20GK103148855SQ201310060409
公开日2013年6月12日 申请日期2013年2月27日 优先权日2013年2月27日
发明者陈熙源, 李庆华, 徐元, 高金鹏, 申冲 申请人:东南大学