发明内容
本实用新型的目的是提供一种减少盲区的室内定位系统及方法,解决了待测物体需要佩戴额外的装配,使用不方便的问题。
为实现上述目的,本实用新型提供了如下方案:
一种减少盲区的室内定位系统,包括第一传感器组,第二传感器组,数据处理器,数据处理器与第一传感器组、第二传感器组连接,数据处理器与上位机连接;第一传感器组包括不少于两个超声波传感器、第二传感器组不少于两个超声波传感器。
可选的,还包括WIFI模块,WIFI模块与数据处理器连接,减少盲区的室内定位系统通过WIFI模块与上位机连接。
可选的,第一传感器组包括四个超声波传感器、第二传感器组包括四个超声波传感器。
可选的,第一传感器组和第二传感器组的超声波传感器之间角度可以调节。
可选的,超声波传感器包括超声波反射器和超声波接收器。
可选的,减少盲区的室内定位系统用于三维空间定位。
根据本实用新型提供的具体实施例,本发明公开了以下技术效果:
本实用新型使用两个传感器组,解决了待测物体需要佩戴额外装配问题,使用方便的问题,每个传感器组包括多个成一定角度的超声波传感器轮流工作,提高了室内定位精度。
具体实施方式
下面将结合本实用新型实施例中的附图,对本实用新型实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本实用新型中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本实用新型的目的是提供一种减少盲区的室内定位系统与方法,解决了待测物体需要佩戴额外的装配,使用方便的问题,提高了室内定位精度。
为使本实用新型的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本实用新型作进一步详细的说明。
图1为本实用新型的一种减少盲区的室内定位系统的实施例的结构示意图。如图1所示,该定位系统包括:第一传感器组(3),第二传感器组(4),数据处理器(2),数据处理器(2)与第一传感器组(3)、第二传感器组(4)连接,数据处理器(2)连接。还包括WIFI模块,WIFI模块与数据处理器连接,数据处理器系统通过WIFI模块与上位机连接。第一传感器组(3)包括四个超声波传感器、第二传感器组包括四个超声波传感器。第一传感器组(3)和第二传感器组(4)的超声波传感器之间角度可以调节。超声波传感器包括超声波反射器和超声波接收器。
图4为本实用新型的一种减少盲区的室内定位方法的实施例的流程图,一种减少盲区的室内定位方法,方法包括:
步骤401:以第一传感器组为原点,第一传感器组与第二传感器组连线为纵轴,建立直角坐标系,待测物在第一象限内;
步骤402:第一传感器组发射超声波,接收待测物体返回超声波,得到从发出超声波到接收到返回超声波所用时间t1o;
步骤403:第二传感器组发射超声波,接收待测物体返回超声波,得到从所述发出超声波到接收到返回超声波所用时间t2o;
步骤404:获得待测物体在直角坐标系的坐标,计算公式:
其中,L1o为待测物到第一传感器组的距离,L2o为待测物到第二传感器组的距离,t1o为第一传感器组从发出超声波到接收到返回超声波所用时间,t2o为第二传感器组从发出超声波到接收到返回超声波所用时间,v为超声波在空气中的传播速度,y2为第一传感器组到第二传感器组的距离,x为待测物在直角坐标系横坐标,y为待测物在直角坐标系纵坐标。
一种减少盲区的室内定位方法,方法包括:
步骤1:以第一传感器组为原点,第一传感器组与第二传感器组连线为纵轴,建立直角坐标系,待测物在第一象限内;
第一超声波传感器、第二超声波传感器、第三超声波传感器、第四超声波传感器之间的角度为30度,第五超声波传感器、第六超声波传感器、第七超声波传感器、第八超声波传感器之间的角度为30度,
步骤2:第一超声波传感器、第二超声波传感器、第三超声波传感器、第四超声波传感器依次发射信号,直到有被测物体反射被接收后,停止轮询,得到从发出超声波到接收到返回超声波所用时间t1o;
步骤3:第五超声波传感器、第六超声波传感器、第七超声波传感器、第八超声波传感器依次发射信号,直到有被测物体反射被接收后,停止轮询,得到从发出超声波到接收到返回超声波所用时间t2o;
步骤4:获得待测物体在直角坐标系的坐标,计算公式:
其中,L1o为待测物到第一传感器组的距离,L2o为待测物到第二传感器组的距离,t1o为第一传感器组从发出超声波到接收到返回超声波所用时间,t2o为第二传感器组从发出超声波到接收到返回超声波所用时间,v为超声波在空气中的传播速度,y2为第一传感器组到第二传感器组的距离,x为待测物在直角坐标系横坐标,y为待测物在直角坐标系纵坐标。
该方法提出的定位需要在参考节点1和2分别放置四对超声波传感器,每对传感器包括一个接收器和一个发射器。超声波传感器角度均为30°,因此每个参考节点放置四对传感器将能覆盖全部区域,而且有重合部分,避免了有些区域覆盖不到的问题,减少了盲区。传感器放置以及覆盖的布局示意图如图2所示:
由图2可知,不管待测物体在哪,参考节点1和参考节点2均能将发射的超声波被待测物体返回后接收。
整个定位过程为:对参考节点1和参考节点2的传感器分别标号为①②③④,⑤⑥⑦⑧,在定位过程中,只有一个传感器发射信号,另外七个都不发射,参考节点1从标号①开始发射,若没有被待测物体返回,则标号②开始发射,直到经待测物体反射被接收后,参考节点1的其他标号传感器不再轮询发射,由此可得到参考节点1到待测物体的距离。参考节点2同理,从标号⑤开始发射,得到参考节点2到待测物体的距离。
假设参考节点1的坐标为(0,0),参考节点2的坐标为(0,),算法模型如图3所示:
超声波在当前室内环境下的声速为v,目标物为O,参考节点1和参考节点2的超声波传感器发射,经过待测物体O反射后所传输的路径分别为,传输的时间分别为,,则超声波沿各路径传输所经过的距离用公式表示为:
由此可知参考节点1,待测物体O和参考节点2组成的三角形的三边长度,根据公式
可得待测物体的坐标为:
该方法采用高精度的超声波作为定位算法的测距技术,利用超声波反射的特性,提出了一种基于超声波测量路径的定位算法,利用TOA定位算法测出超声波反射路径的传输距离,建立已知三边的定位算法。该定位过程无需待测物体佩戴额外的装配,覆盖范围较大,使用方便,易于扩展,在空间内增加非共面节点即可拓展至三维定位空间。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的系统而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
本文中应用了具体个例对本实用新型的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本实用新型的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。