一种基于超声波的室内定位系统及方法
【专利摘要】本发明公开了一种基于超声波的室内定位系统及方法，该系统包括依次连接的超声波发射单元、超声波接收单元和数据处理单元；该系统实现室内定位的方法：超声波发射单元产生两种不同频率的超声波，并以预定的时间间隔按预定的顺序发送超声波；超声波接收单元接收超声波发射单元发出的超声波，滤除干扰杂波，并将处理后的信号传输至数据处理单元；数据处理单元对超声波接收单元传入的数据进行处理，获得移动物体的三维坐标。本发明通过超声波发射单元的特殊设计，以及时间差的应用，解决了超声波发射端与接收端的时间同步问题，移动物体不需发射信号，仅靠接收信号就能完成定位；定位解算高效，实现了移动物体的空间准确定位。
【专利说明】一种基于超声波的室内定位系统及方法
【技术领域】
[0001] 本发明属于室内导航定位【技术领域】，涉及一种基于超声波的室内定位系统，用于 对室内移动物体进行定位，本发明还介绍了该室内定位系统的定位方法。
【背景技术】
[0002] 室内定位与导航是指实时地确定移动机器人的方位，并指引其沿正确路线运动。 移动机器人的定位方法可分为相对定位方法和绝对定位方法。
[0003] 相对定位技术主要有航位推测法和惯性导航法，基本思路都是基于测量值的累 积，因而无法避免时间漂移问题。随着路径的增长，任何小的误差经过累积都会无限增加。 因此，相对定位技术不适合长距离和长时间的准确定位。
[0004] 绝对定位技术主要有全球定位系统（GPS)和路标定位。目前民用GPS的精度一般 在5到10米，用于移动机器人定位时存在近距离定位精度低的问题。路标定位是一种常见 的定位技术，路标是具有明显特征的能被机器人传感器识别的特殊物体。根据路标的不同， 分为基于自然路标定位和基于人工路标定位。其中人工路标定位技术应用最为成熟。人工 路标是指在机器人的工作环境中，人为地设置一些坐标已知的路标，机器人通过对路标的 探测来确定自身的位置。移动机器人需要利用传感器才能对路标进行感知以获得环境信 息。用于感知的传感器主要分两类：视觉传感器和非视觉传感器。视觉传感器用于获取环 境的视觉信息，而非视觉传感器用于获取机器人与周围路标的距离信息。常用的非视觉传 感器包括超声波传感器、红外传感器、激光测距仪等等。
[0005] 激光测距仪的测量结果精度较高，但是由于其高分辨率造成数据处理实时性较 差，而且激光测距仪的能源消耗较大。红外线技术通过移动设备在一个预定时间间隔内发 射红外线，然后接收这些红外线并利用到达时间算法或到达角度算法计算目标位置，缺点 是红外线是直线短距离传播的，容易受太阳光干扰且精确度不是很高。超声波由于其廉价、 使用简单、数据处理方便等特点得到了广泛使用，但由于超声波传感器信息量相对较少、遇 到障碍物会丢失、受物体反射会造成虚假信号，因此其感知信息存在较大的不确定性。
[0006] 目前，常见的基于超声波的室内定位技术主要有以下几种方案：
[0007] 第一种为多超声波定位技术。该技术米用全局定位，可在移动机器人身上4个朝 向安装4个超声波传感器，将待定位空间分区，由超声波传感器测距形成坐标。采用这种方 法定位，如果遇到平面上有障碍物，必然会出现定位坐标错误。
[0008] 第二种是采用反射式测距法。系统由一个主接收器和若干电子标签组成，主接收 器可放置于移动机器人上，各个电子标签放置于室内空间的固定位置。先由上位机发送信 号给各个电子标签，电子标签接收到信号后又发射超声波传输给主测距器，从而可以确定 各个电子标签到移动机器人之间的距离，并解算出定位坐标。这种方法的缺点是需要采集 发射点的时间信号，即需要上位机告知移动机器人发射的时间点。
[0009] 还有一种常见方法是将超声波的发送端放置于移动机器人上，各个电子标签作为 接收端放置于室内空间的固定位置，这样通过在移动机器人上发送超声波，就可以确定各 个电子标签到移动机器人之间的距离，并解算出定位坐标。但是通过这种方法，解算的定位 坐标信息在上位机上，必须与移动机器人建立通信。
[0010] 此外，出现了一种新的方法是将超声波与射频技术（或红外线等技术）相结合进 行定位。由于射频信号传输速率接近光速，远高于射频速率，那么可以利用射频信号先激活 电子标签而后使其接收超声波信号，利用时间差的方法测距。这种方法虽然解决了需要采 集时间信号的问题，但是使用射频技术必然会增加大量成本。
[0011] 以上常见超声波的室内定位方法多采用三点测位方式，即测量待测点到三个坐标 已知的固定点之间的距离，然后通过距离交会法求解出待测点位的三维坐标。这种方法在 理论上，有三个圆相交于一点即移动机器人的位置，但实际上由于测量数据误差的存在，这 三个圆并非相交于一点而是三点，给定位坐标带来较大的误差。因此，需要对现有室内定位 方法进行改进，设计一种更加合理的室内定位系统和方法，从而减小移动物体的定位误差。
【发明内容】
[0012] 针对上述现有超声波室内定位系统的缺陷，本发明的主要目的在于设计一种基于 超声波的室内定位系统。本发明的室内定位系统简单可行，设计合理。通过本发明的室内定 位系统及创新性的定位方法能够准确的定出移动物体在建立的空间坐标系中的三维坐标。
[0013] 本发明采取的技术方案是：
[0014] 一种基于超声波的室内定位系统，其特征在于包括依次连接的超声波发射单元、 超声波接收单元和数据处理单元。
[0015] 所述超声波发射单元，用于产生两种不同频率的超声波，并以预定的时间间隔按 预定的顺序发送超声波。
[0016] 所述超声波接收单元，用于接收超声波发射单元发出的超声波，滤除干扰杂波，并 将处理后的信号传输至数据处理单元。
[0017] 所述数据处理单元，用于对超声波接收单元传入的数据进行处理，获得移动物体 的三维坐标。
[0018] 进一步地，所述超声波发射单元包括超声波发射探头、单片机控制单元、信号传输 单元和信号驱动单元。
[0019] 所述单片机控制单元，含有控制器，用于产生远程控制信号，控制超声波发射探头 产生两种不同频率的超声波信号，并控制超声波发射探头发射超声波信号的时间间隔与循 环方式。
[0020] 所述信号传输单元，通过预定的通信协议将单片机控制单元产生的远程控制信号 远距离传输给信号驱动单元。
[0021] 所述信号驱动单元，包含驱动器，用于增强远程控制信号的驱动能力，驱动超声波 发射探头发射超声波。
[0022] 进一步地，所述超声波接收单元包括信号放大单元和信号整形单元。
[0023] 所述信号放大单元包括超声波接收探头和放大器，超声波接收探头用于接收超声 波信号，并将超声波信号转化为同频的电压正弦信号；放大器用于将电压正弦信号进行放 大，并将放大后的电压正弦信号传给信号整形单元。
[0024] 所述信号整形单元，包括比较器，用于将电压正弦信号整形为方波。
[0025] 进一步地，所述数据处理单元包括温度传感器和单片机处理器。
[0026] 所述温度传感器，用于实时测量室内温度，并将测得的室内温度传送给单片机处 理器。
[0027] 所述单片机处理器，用于对超声波接收单元传入的数据进行解算，确定移动物体 在空间坐标系中的坐标。
[0028] 进一步地，所述超声波发射探头为若干个，所有超声波发射探头在室内坐标系中 位置已知，彼此之间相对位置固定，并构成结构稳定的基线对。
[0029] 进一步地，所述超声波发射探头中的一个超声波发射探头发射一种频率的超声 波，其余的超声波发射探头均发射不同于该频率的超声波。
[0030] 进一步地，所述超声波发射探头按预定的时间间隔和预定的顺序发射超声波，并 按此循环。
[0031] 进一步地，所述超声波接收单元和数据处理单元均安装在移动物体上。
[0032] 进一步地，所述超声波发射探头安装在室内的天花板上。
[0033] 本发明的技术方案进一步包括：
[0034] 一种基于超声波的室内定位系统的室内定位方法，包括下述步骤：
[0035] 步骤一、单片机控制单元依次通过信号传输单元和信号驱动单元，控制每个超声 波发射探头以预订的时间间隔依次循环发射超声波信号，第一个超声波发射探头发射超声 波的频率为Π ，其余超声波发射探头发射超声波的频率为f2。
[0036] 步骤二、超声波接收单元中的超声波接收探头接受传入的两种频率的超声波信 号，经放大、整形后传输给单片机处理器。
[0037] 步骤三，单片机处理器在收到超声波接收单元传来的信号后，开始记时，得到相邻 两次超声波到达的时间差，由此时间差得到移动物体到相邻超声波发射探头的距离差；由 前两次距离差列出一个方程组，解得移动物体在此坐标系内的坐标；再在另一个空间坐标 系内，根据空间中的几何关系，确定出移动物体的坐标。
[0038] 与现有技术相比，本发明的优点是：
[0039] (1)本发明通过超声波发射单元的特殊设计，以及时间差的应用，解决了超声波发 射端与接收端的时间同步问题，待定位物体（移动物体）不需要发射信号，仅靠接收信号就 能完成定位，从而高效的实现了无源定位。
[0040] (2)本发明通过高效的定位解算算法，可以确定出移动物体的空间坐标，从而不仅 可以定位出地面上的移动物体,也可以定位出空间中的移动物体。
[0041] 以下将结合附图和实施例对本发明做进一步详细说明。
【专利附图】
【附图说明】
[0042] 图1是本发明系统的结构框图。
[0043] 图2是本发明系统中超声波发射单元的具体设计方案图。
[0044] 图3是本发明系统中超声波接收单元与数据处理单元的具体设计方案图。
[0045] 图4是本发明系统时间差计算分析图。
[0046] 图5是本发明系统超声波接收端解算定位算法分析图。
【具体实施方式】
[0047] 现有室内定位方法普遍存在的技术缺陷是对移动物体（待定位物体）的定位误差 较大，定位不准确。为此，本发明对现有室内定位方法进行改进，设计了一种基于超声波的 室内定位系统，并对该室内定位系统的室内定位方法进行了介绍。
[0048] 如图1所示，本发明的室内定位系统包括超声波发射单元、超声波接收单元、数据 处理单元三部分。所述三个单元都是单向连接的，即超声波发射单元产生信号，信号经超声 波接收单元传输给数据处理单元。进一步地，超声波发射单元产生两种不同频率的超声波 信号，经过大气传播后由超声波接收单元收到，并将信号进行放大与整形，传递给数据处理 单元，在数据处理单元中通过解算定位算法，确定被移动物体的空间坐标。
[0049] 三个单元的具体功能描述如下。超声波发射单元，用于产生两种不同频率的超声 波，并以预定的时间间隔按预定的顺序发送超声波。超声波接收单元，用于接收超声波发射 单元发出的超声波，滤除干扰杂波，并将处理后的信号传输至数据处理单元。数据处理单 元，用于对超声波接收单元传入的数据进行处理，获得移动物体的三维坐标。
[0050] 超声波发射单元的结构组成如图2所示，包括超声波发射探头、单片机控制单元、 信号传输单元和信号驱动单元。
[0051] 超声波发射单元中可以包含多个超声波发射探头，超声波发射探头安装在室内的 天花板上或室内较高的位置，所有超声波发射探头处于同一高度，且只有其中的三个超声 波发射探头处在同一条直线上。此外，超声波发射探头中的一个超声波发射探头发射一种 频率的超声波，其余的超声波发射探头均发射不同于该频率的超声波。
[0052] 单片机控制单元包含有控制器，用于产生远程控制信号，控制超声波发射探头产 生两种不同频率的超声波信号，并控制超声波发射探头发射超声波信号的时间间隔与循环 方式。
[0053] 信号传输单元，通过预定的通信协议将单片机控制单元产生的远程控制信号远距 离传输给信号驱动单兀。
[0054] 信号驱动单元包含驱动器，用于增强远程控制信号的驱动能力，驱动超声波发射 探头发射超声波。
[0055] 在图2中，超声波发射单元通过一个控制器，运用MAX485通信协议，将控制信号远 距离传输给超声波发射探头，并通过非门的连接增加信号的驱动能力。本发明的室内定位 系统可以设置有四路超声波发射单元，每个超声波发射单元分别隔一定时间间隔发射一组 超声波，需要说明的是，四路超声波发射单元产生两种不同频率的超声波。超声波的发射是 由超声波发射探头实现的，如图2所示，1' 1、1'2、1'3、1'4均为超声波发射探头，其中1' 1为251(的 超声波发射探头，T2、T3、T4皆为40K的超声波发射探头。
[0056] 超声波接收单元的结构组成包括信号放大单元和信号整形单元，如图3所示。其 中，信号放大单元包括超声波接收探头和放大器。超声波接收探头用于接收超声波信号，并 将超声波信号转化为同频的电压正弦信号。超声波发射探头为若干个，安装在室内的天花 板上或室内较高的位置，所有超声波发射探头在室内坐标系中位置已知，彼此之间相对位 置固定，并构成结构稳定的基线对。放大器用于将电压正弦信号进行放大，并将放大后的电 压正弦信号传给信号整形单元。所述信号整形单元，包括比较器，用于将电压正弦信号整形 为方波。
[0057] 在图3中，&表示25K的超声波接收探头，R2表示40K的超声波接收探头。札与 馬在接收到超声波发射端（超声波发射探头）传来的超声波信号后，将其转化为同频的电 压正弦信号。由于超声波发射探头与超声波接收探头的距离较远，导致接收到的信号比较 微弱，因此需通过放大器放大到一定幅度，再通过比较器将正弦信号整形为方波信号。整形 后的方波信号传输到数据处理单元。
[0058] 整形后的方波信号传送到MSP430单片机处理器中进行处理，通过定位算法得到 移动物体的具体坐标值。由于超声波在空气中的传播速度受温度影响，因此通过温度传感 器测得温度，将得到的结果传到MSP430单片机处理器上可算出此时声波在空气中的传播 速度v。MSP430单片机处理器在定位后，可以通过与电脑间的串口通信，将定位结果传到PC 机上，进行进一步的处理。
[0059] 从上述描述可以看出，本系统实现定位的基本思路是：在天花板或较高位置安放 四个超声波发射探头，其中第一个发射探头发射频率定为Π ，其余探头的发射频率选为 f2。发射单元使用一个控制器控制发射端的每个探头，以一定的时间间隔依次循环发射超 声波，该时间间隔越小，每次定位所需时间越小，但应当大于超声波通过房间对角线所需时 间。在移动物体上安放超声波接收单元与数据处理单元。当移动物体接收到第一个发射探 头的超声波时，开始进行计时，接收到后面三个探头的超声波的时间分别为t 2、t3、t4，从而 利用超声波定位解算算法进行解算，解算完后再等待接收第一个探头的超声波作为下一次 定位的起始，从而循环进行定位解算。
[0060] 为了更好地理解本发明室内定位系统的实现室内定位的原理，现结合具体的定位 过程进行描述。如图4所示，四个超声波发射探头每隔30ms发一组超声波信号，即?\先发 一组25Κ的超声波信号，30ms后，Τ 2发一组40Κ的超声波信号，过30ms，Τ3发一组40Κ的超 声波信号，再过30ms，Τ 4发一组40Κ的超声波信号。Λ &为超声波发射探头?\发出25Κ超 声波信号到超声波接收探头&接收到信号需的时间，△ t2为超声波发射探头发出40Κ超声 波信号到超声波接收探头R2接收到信号需的时间，△ t3为发射端T3发出40K超声波信号到 超声波接收探头R2接收到信号需的时间，△ t4为发射端Τ4发出40Κ超声波信号到超声波接 收探头馬接收到信号需的时间。
[0061] 测量札、测量Μ2、测量Μ3分别是通过MSP430单片机处理器测得的时间值。由图4 可知 Δ?^-Δ?^: (M2-30)ms;At4-At3= (M3_30)ms。
[0062] 在如图5所示的空间直角坐标系中，?\为25K的超声波发射探头，T2、T 3、T4分别为 40Κ的超声波发射探头，且相邻超声波发射探头?\与Τ2、Τ 2与Τ3、Τ3与Τ4的距离皆为2Cl。 超声波发射探头?\、T 2、T3、T4位于同一平面上，T4、T3所在的直线垂直于?\、T 2、T3所在的直 线。超声波接收探头R的坐标为（x，y，z)。qi、q 2、q3分别表示为抑3、1^'、1?1'4的长度。
[0063] ai为超声波发射探头T2与?\到超声波接收探头R的距离差，即图5中的RI^-RTi。 a2为超声波发射探头T3与T2到超声波接收探头R的距离差，即图5中的RT 3-RT2。根据双 曲线的定义，到两点的距离差为常数的点在双曲线上，由距离差叫、a 2可以联立两个双曲线 方程，得到方程组①，
【权利要求】
1. 一种基于超声波的室内定位系统，其特征在于包括依次连接的超声波发射单元、超 声波接收单元和数据处理单元； 所述超声波发射单元，用于产生两种不同频率的超声波，并以预定的时间间隔按预定 的顺序发送超声波； 所述超声波接收单元，用于接收超声波发射单元发出的超声波，滤除干扰杂波，并将处 理后的信号传输至数据处理单元； 所述数据处理单元，用于对超声波接收单元传入的数据进行处理，获得移动物体的三 维坐标。
2. 根据权利要求1所述的基于超声波的室内定位系统，其特征在于，所述超声波发射 单元包括超声波发射探头、单片机控制单元、信号传输单元和信号驱动单元； 所述单片机控制单元，含有控制器，用于产生远程控制信号，控制超声波发射探头产生 两种不同频率的超声波信号，并控制超声波发射探头发射超声波信号的时间间隔与循环方 式； 所述信号传输单元，通过预定的通信协议将单片机控制单元产生的远程控制信号远距 离传输给信号驱动单元； 所述信号驱动单元，包含驱动器，用于增强远程控制信号的驱动能力，驱动超声波发射 探头发射超声波。
3. 根据权利要求1所述的基于超声波的室内定位系统，其特征在于，所述超声波接收 单元包括信号放大单元和信号整形单元； 所述信号放大单元包括超声波接收探头和放大器，超声波接收探头用于接收超声波信 号，并将超声波信号转化为同频的电压正弦信号；放大器用于将电压正弦信号进行放大，并 将放大后的电压正弦信号传给信号整形单元； 所述信号整形单元，包括比较器，用于将电压正弦信号整形为方波。
4. 根据权利要求1所述的基于超声波的室内定位系统，其特征在于，所述数据处理单 元包括温度传感器和单片机处理器； 所述温度传感器，用于实时测量室内温度，并将测得的室内温度传送给单片机处理 器； 所述单片机处理器，用于对超声波接收单元传入的数据进行解算，确定移动物体在空 间坐标系中的坐标。
5. 根据权利要求2所述的基于超声波的室内定位系统，其特征在于，所述超声波发射 探头为若干个，所有超声波发射探头在室内坐标系中位置已知，彼此之间相对位置固定，并 构成结构稳定的基线对。
6. 根据权利要求2或5所述的基于超声波的室内定位系统，其特征在于，所述超声波发 射探头中的一个超声波发射探头发射一种频率的超声波，其余的超声波发射探头均发射不 同于该频率的超声波。
7. 根据权利要求2或5所述的基于超声波的室内定位系统，其特征在于，所述超声波发 射探头按预定的时间间隔和预定的顺序发射超声波，并按此循环。
8. 根据权利要求1所述的基于超声波的室内定位系统，其特征在于，所述超声波接收 单元和数据处理单元均安装在移动物体上。
9. 根据权利要求2或5所述的基于超声波的室内定位系统，其特征在于，所述超声波发 射探头安装在室内的天花板上。
10. -种基于超声波的室内定位系统的室内定位方法，其特征在于包括下述步骤： 步骤一、单片机控制单元依次通过信号传输单元和信号驱动单元，控制每个超声波发 射探头以预订的时间间隔依次循环发射超声波信号，第一个超声波发射探头发射超声波的 频率为Π ，其余超声波发射探头发射超声波的频率为f2 ; 步骤二、超声波接收单元中的超声波接收探头接受传入的两种频率的超声波信号，经 放大、整形后传输给单片机处理器； 步骤三，单片机处理器在收到超声波接收单元传来的信号后，开始记时，得到相邻两次 超声波到达的时间差，由此时间差得到移动物体到相邻超声波发射探头的距离差；由前两 次距离差列出一个方程组，解得移动物体在此坐标系内的坐标；再在另一个空间坐标系内， 根据空间中的几何关系，确定出移动物体的坐标。
【文档编号】G01S5/26GK104062633SQ201410330642
【公开日】2014年9月24日 申请日期:2014年7月11日 优先权日:2014年7月11日
【发明者】张华 , 许录平, 焦荣, 谢春晖, 周伟, 孙景荣, 宋诗斌, 申洋赫, 闫博 申请人:西安电子科技大学