CN105785352B - 一种防丢失监控方法及定位装置 - Google Patents
一种防丢失监控方法及定位装置 Download PDFInfo
- Publication number
- CN105785352B CN105785352B CN201610253428.6A CN201610253428A CN105785352B CN 105785352 B CN105785352 B CN 105785352B CN 201610253428 A CN201610253428 A CN 201610253428A CN 105785352 B CN105785352 B CN 105785352B
- Authority
- CN
- China
- Prior art keywords
- module
- positioner
- relative distance
- supervisor
- monitored person
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S11/00—Systems for determining distance or velocity not using reflection or reradiation
- G01S11/02—Systems for determining distance or velocity not using reflection or reradiation using radio waves
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S11/00—Systems for determining distance or velocity not using reflection or reradiation
- G01S11/02—Systems for determining distance or velocity not using reflection or reradiation using radio waves
- G01S11/06—Systems for determining distance or velocity not using reflection or reradiation using radio waves using intensity measurements
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S11/00—Systems for determining distance or velocity not using reflection or reradiation
- G01S11/14—Systems for determining distance or velocity not using reflection or reradiation using ultrasonic, sonic, or infrasonic waves
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Emergency Alarm Devices (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开了一种防丢失监控方法及定位装置,本防丢失监控方法其基于行人航迹推算获得监控者与被监控者的第一相对距离及基于RSSI算法获得两者的第二相对距离,然后进行判断分析获得两者的当前相对距离,若当前相对距离超出预设安全范围,则发出警报,便于提醒监控者并防止危险事故的发生。本方法简单方便、易于实现、安全距离可调、精度高、反应快且可自动报警。
Description
技术领域
本发明涉及定位导航领域,特别是涉及了一种防丢失监控方法及定位装置。
背景技术
现实中经常有一位家长带领一个或多个2~10岁的孩子逛商场,逛公园。家长如何确定自己与孩子的相对距离和方向是个难题。孩子的活动范围既包括室内也包括室外,室内由于无法接收GPS信号,不能使用即使能使用也容易出现定位不准确的问题。室内外可同时定位的技术主要是蜂窝网移动定位技术,但该技术目前仍然无法找到在各种条件下普遍适用的抗非直达波影响的算法,定位精度约为150米。而市场上现有的蓝牙防丢贴片,定位范围无遮挡情况下仅为20米,且蓝牙稳定性差,经常连不上,非视距干扰严重。室内无线定位技术,则要求所有的基站位置事先设定好,一旦环境改变或网络覆盖范围发生变化,最终得到的定位结果就会出现严重误差。由于孩子是一个移动群体,且室内外所在地点环境时刻发生改变,如何在不依赖固定基站环境下实现儿童群定位一直是一个亟待解决的问题。
发明内容
为了解决上述现有技术的不足,本发明提供了一种防丢失监控方法,其基于行人航迹推算获得监控者与被监控者的第一相对距离及基于RSSI算法获得两者的第二相对距离,然后进行判断分析获得两者的当前相对距离,若当前相对距离超出预设安全范围,则发出警报,便于提醒监控者并防止危险事故的发生。本方法简单方便、易于实现、安全距离可调、精度高、反应快且可自动报警。本发明还提供了一种定位装置。
本发明所要解决的技术问题通过以下技术方案予以实现:
一种防丢失监控方法,其包括以下步骤:
(1)监控者定位装置和至少一被监控者定位装置获得各自的当前位置坐标,监控者定位装置接收每一被监控者定位装置发送的位置坐标信号并计算获得两者的第一相对距离和方位;
(2)监控者定位装置根据接收到的信号强弱计算两者的第二相对距离,其基于RSSI测距算法获得;
(3)判断第二相对距离是否超过预定阈值;若低于预定阈值,则将第一相对距离和第二相对距离进行加权计算获得两者的当前相对距离与所述方位一并发送至智能终端,且进入步骤(4);若超过预定阈值,则将第一相对距离作为两者的当前相对距离与所述方位一并发送至智能终端,且进入步骤(4);
(4)判断当前相对距离是否超过预设安全范围,若不超出预设安全范围,则返回步骤(1);若超出预设安全范围,则监控者定位装置和被监控者定位装置均发出警报。
在本发明中,所述步骤(1)具体包括以下步骤:
(1.1)监控者定位装置与至少一被监控者定位装置相互绑定,每一被监控者定位装置获取的当前位置坐标实时发送至监控者定位装置;
(1.2)监控者和被监控者分别穿戴监控者定位装置与被监控者定位装置,监控者定位装置与被监控者定位装置获取对应穿戴者的当前位置坐标,具体步骤如下:
(2.1)基于超声波收发模块和无线电收发模块进行TDOA测距,获得行走周期内两脚之间的实时距离;
(2.2)基于双磁罗盘进行航向角检测;
(2.3)基于步骤(2.1)、(2.2)获得行人航迹的步幅和运算航向角;
(2.4)将步骤(2.3)的的步幅和运算航向角代入行人航迹推算的计算公式即北向坐标:,东向坐标:,即当前行人位置坐标;其中,表示行人的初始位置,i表示第i个行走周期,n表示行走n个行走周期;
(1.3)被监控者定位装置发送当前位置坐标至监控者定位装置,监控者定位装置接收被监控者的当前位置坐标并计算获得两者的相对距离和方位,即第一相对距离和方位。
在本发明中,所述预定阈值为5~15m,也可根据实际情况如硬件条件和应用环境做适当调整。
在本发明步骤(3)中,进行加权计算时,所述第一相对距离的加权比重为0~50%,所述第二相对距离的加权比重为50~100%。
在本发明中,所述每一被监控者定位装置包括左右脚环;所述左脚环作为信号发送端,包括第一主控制器,与所述第一主控制器连接的无线电发射模块、超声波发射模块、第一磁罗盘,所述第一主控制器主要用于控制各模块及负责同时发送无线电信号和超声波信号;所述右脚环作为信号接收处理端,包括第二主控制器,与所述第二主控制器连接的无线电接收模块、超声波接收模块、第二磁罗盘、无线通信模块及警报模块,所述第二主控制器主要用于控制各模块及负责接收无线电信号和超声波信号、处理信号并计算获得行人航迹的行人位置坐标;
所述监控者定位装置与被监控者定位装置不同之处在于:所述第二主控制器还包括数据处理模块、RSSI测距模块、第一判断模块、第二判断模块;所述数据处理模块用于根据监控者定位装置的当前位置坐标与接收到的被监控者定位装置的当前位置坐标计算获得两者的第一相对距离和方位、还用于根据第一判断模块发送的判断结果获得两者的当前相对距离;所述RSSI测距模块用于根据接收信号的强弱计算监控者定位装置与被监控者定位装置之间的第二相对距离;所述第一判断模块与所述RSSI测距模块及数据处理模块连接,用于判断所述第二相对距离是否超出预定阈值且将判断结果发送至数据处理模块;所述第二判断模块与所述数据处理模块连接,用于判断所述第一相对距离是否超出预设安全范围。
在本发明中,所述超声波发射模块和超声波接收模块组成超声波收发模块;将所述左右脚环穿戴在脚踝上时,所述超声波收发模块朝向两脚内侧,双磁罗盘朝向人行走的正前方。
在本发明中,所述无线电发射模块设置在所述第一环状承载体的弧形顶部处,所述超声波发射模块靠近所述无线电发射模块;所述无线电接收模块设置在所述第二环状承载体的弧形顶部处,所述超声波接收模块靠近所述无线电接收模块。
在本发明中,所述无线电发射模块和无线电接收模块在穿戴时要相互对准。
在本发明中,所述超声波发射模块和超声波接收模块组成超声波收发模块;所述超声波收发模块的水平面收发角度为100~180°,竖直面收发角度为100~180°。
一种定位装置,其包括左右脚环;所述左脚环作为信号发送端,包括第一主控制器,与所述第一主控制器连接的无线电发射模块、超声波发射模块、第一磁罗盘,所述第一主控制器主要用于控制各模块及负责同时发送无线电信号和超声波信号;所述右脚环作为信号接收处理端,包括第二主控制器,与所述第二主控制器连接的无线电接收模块、超声波接收模块、第二磁罗盘、无线通信模块及警报模块,所述第二主控制器主要用于控制各模块及负责接收无线电信号和超声波信号、处理信号并计算获得行人航迹的行人位置坐标。
在本发明中,所述第二主控制器还包括数据处理模块、RSSI测距模块、第一判断模块、第二判断模块;所述数据处理模块用于根据本定位装置的当前位置坐标与接收到的其他定位装置的当前位置坐标计算获得两者的第一相对距离和方位、还用于根据第一判断模块发送的判断结果获得两者的当前相对距离;所述RSSI测距模块用于根据接收信号的强弱计算本定位装置与其他定位装置之间的第二相对距离;所述第一判断模块与所述RSSI测距模块及数据处理模块连接,用于判断所述第二相对距离是否超出预定阈值且将判断结果发送至数据处理模块;所述第二判断模块与所述数据处理模块连接,用于判断所述第一相对距离是否超出预设安全范围。
在本发明中,所述超声波收发模块为一组超声波收发模块或多组超声波收发模块。
本发明具有如下有益效果:
(1)防丢失监控方法,其基于行人航迹推算获得监控者与被监控者的第一相对距离及基于RSSI算法获得两者的第二相对距离,然后进行判断分析获得两者的当前相对距离,若当前相对距离超出预设安全范围,则发出警报,便于提醒监控者并防止危险事故的发生。本方法简单方便、易于实现、安全距离可调、精度高、反应快且可自动报警;
(2)本方法的行人定位装置为方便穿戴在监控者和被监控者身上的脚环,即将硬件集成在脚环上,方便拆装且携带方便、抗干扰能力强、可靠性高、稳定性强,且通用性高,无需复杂的安装连接,直接拆装适用于任何人,特别是针对儿童及老人;解决了现有定位方法硬件安装复杂、不便于携带、拆装不便,且干扰性较强、稳定性较弱及无法实现通用性的问题;同时,无惯性漂移的问题,不依赖固定基站,无非视距干扰,可实现室内外自主定位,解决了现有室内外无缝定位时依赖固定基站、惯性漂移及干扰性强的难题,实现了不依赖固定基站环境下对人群进行准确定位;跟踪范围仅受限于Zigbee的通信范围,一般为1km,远优于现有的20m~50m,故当被监控者超出了预设的安全范围,仍然能进行有效的跟踪定位。
附图说明
图1为本发明防丢失监控方法的流程示意图;
图2为本发明防丢失监控方法的原理示意图,其行人定位装置为可记录轨迹坐标的脚环;
图3为本发明被监控者定位装置左脚环的结构示意图;
图4为图3的侧视图;
图5为本发明被监控者定位装置右脚环的结构示意图;
图6为本发明超声波收发模块的水平收发角度示意图;
图7为本发明超声波收发模块的竖直收发角度示意图;
图8为本发明行人定位装置定位方法的流程示意图;
图9为本发明行人定位装置定位方法中航向角计算的示意图;
图10为本发明行人定位装置定位方法中步幅变化曲线的示意图;
图11为本发明防丢失监控系统的原理框图。
具体实施方式
下面结合附图和实施例对本发明进行详细的说明。
实施例1
如图1所示,一种防丢失监控方法,其包括以下步骤:
(1)监控者和至少一个被监控者分别通过自身所穿戴的监控者定位装置和至少一被监控者定位装置获得各自的当前位置坐标,监控者定位装置接收每一被监控者定位装置发送的位置坐标信号并计算获得两者的第一相对距离和方位;所述两者为监控者与每一被监控者。
(2)监控者定位装置根据接收到的信号的RSSI(接收信号强度指示)值计算的相对距离信息,即两者的第二相对距离,其基于RSSI测距算法获得;
基于RSSI测距算法获得第二相对距离为现有技术,在此不再赘述。
(3)判断第二相对距离是否超过预定阈值,若低于预定阈值,则将第一相对距离和第二相对距离进行加权计算获得两者的当前相对距离并将该当前相对距离和所述方位发送至智能终端,且进入步骤(4);若超过预定阈值,则将第一相对距离作为两者当前相对距离并将该当前相对距离和所述方位发送至智能终端,且进入步骤(4);
所述预定阈值优选但不限定为5~15米,可根据实际情况如硬件条件和应用环境做适当调整。当第二相对距离低于预定阈值时,则监控者与被监控者相距很近,且中间无障碍物遮挡,此时基于RSSI测距算法测得的第二相对距离可信度高,则将第一相对距离和第二相对距离进行加权计算获得两者当前相对距离,同时把当前相对距离、方位及各自的当前位置坐标发送在监控者的智能终端上显示及作为历史纪录储存。优选地,进行加权计算时,所述第一相对距离的加权比重为0~50%,所述第二相对距离的加权比重为50~100%,更优选地,所述第一相对距离的加权比重为10~30%,所述第二相对距离的加权比重为70~90%,最优选地,所述第一相对距离的加权比重为20%,所述第二相对距离的加权比重为80%。
(4)判断当前相对距离是否超过预设安全范围,若不超出预设安全范围,则返回步骤(1);若超出预设安全范围,则监控者定位装置和被监控者定位装置均发出警报。
值得注意的是,监控者定位装置接收到的监控者和被监控者的当前位置坐标及计算获得的当前相对距离和所述方位均发送至智能终端,显示监控者及被监控者的相对距离和方位以及各自的行走轨迹。当监控者接收到警报后,可在监控者的智能终端上获得两者的当前相对距离及被监控者的当前位置坐标,以实现对被监控者进行有效地安全地实时监控,防止其超出安全范围发生危险事故。当被监控者接收到警报后,可选择在停止在当前位置等监控者到来,也可以朝向靠近监控者的方向移动以回到安全范围内,采取的方式不局限于此。所述安全范围可在智能终端自行修改设定以满足不同环境情况,安全范围的修改替换为现有技术,在此不再赘述。
所述监控者定位装置和被监控者定位装置可以是WIFI定位装置、蓝牙定位装置、Zigbee定位装置、移动通信网络定位装置、依靠GPS/北斗信号室内转发装置定位装置等,还可以是基于行人航迹推算PDR算法设计的实时定位装置,但不局限于此。本发明优选基于行人航迹推算PDR算法设计的实时定位装置,优选地,采用的定位装置为可记录轨迹坐标的脚环,基于该脚环而实现防丢失监控方法的原理如图2所示。
以下对基于行人航迹推算PDR算法设计的实时定位装置做进一步说明:
所述每一被监控者定位装置包括分别穿戴在其左右脚踝上的左脚环和右脚环。
如图3、4所示,所述左脚环作为信号发送端,其包括:第一环状承载体1,和设置在所述第一环状承载体1上的无线电发射模块11、超声波发射模块12、第一磁罗盘13、第一主控制器14、第一电池模块15;所述第一环状承载体1具有一开口,俯视状态下呈C形状,但不局限于此;通过该开口穿戴在左脚踝上,所述开口相对处为环状承载体的弧形顶部,所述无线电发射模块11设置在所述第一环状承载体1的弧形顶部处,所述超声波发射模块12靠近所述无线电发射模块11,所述第一磁罗盘13相对所述无线电发射模块11垂直安装在所述第一环状承载体1一侧;所述第一主控制器14分别与所述无线电发射模块11、超声波发射模块12、第一磁罗盘13及第一电池模块15通信连接,主要用于控制各模块及负责同时发送无线电信号和超声波信号;
如图5所示,所述右脚环作为信号接收处理端,其包括:第二环状承载体2,和设置在所述第二环状承载体2上的无线电接收模块21、超声波接收模块22、第二磁罗盘23、第二主控制器24、第二电池模块25、警报模块(图未显示)及Zigbee通信模块26。所述第二环状承载体2具有一开口,俯视状态下呈C形状,但不局限于此;通过该开口穿戴在右脚踝上,所述开口相对处为环状承载体的弧形顶部,所述无线电接收模块21设置在所述第二环状承载体2的弧形顶部处,所述超声波接收模块22靠近所述无线电接收模块21,所述第二磁罗盘23相对所述无线电接收模块21垂直安装在所述第二环状承载体2一侧;所述第二主控制器24分别与所述无线电接收模块21、超声波接收模块22、第二磁罗盘23、第二电池模块25、警报模块(图未显示)及Zigbee通信模块26通信连接,主要用于控制各模块及负责接收无线电信号和超声波信号、处理信号并计算获得行人航迹的行人位置坐标。
所述监控者定位装置与被监控者定位装置不同之处在于:第二主控制器还包括数据接收模块、数据处理模块、RSSI测距模块、第一判断模块、第二判断模块;所述数据接收模块分别与每一被监控者定位装置和数据处理模块通信连接,用于接收被监控者的当前位置坐标并发送至所述数据处理模块;所述数据处理模块用于将监控者的当前位置坐标与接收到的被监控者当前位置坐标进行计算获得第一相对距离和方位、还用于根据第一判断模块发送的判断结果获得两者的当前相对距离,若判断结果为不超出预定阈值则将第一相对距离和第二相对距离加权融合作为两者当前相对距离,若判断结果为超出预定阈值则将第一相对距离作为两者当前相对距离;所述RSSI测距模块用于根据接收到的信号的RSSI(接收信号强度指示)值计算两者的相对距离信息,即两者的第二相对距离;所述第一判断模块与所述RSSI测距模块及数据处理模块连接,用于判断所述第二相对距离是否超出预定阈值且将判断结果发送至数据处理模块;所述第二判断模块与所述数据处理模块连接,用于判断所述第一相对距离是否超出预设安全范围。
值得注意的是,为了提高检测精度,降低干扰,将所述左右脚环穿戴在脚踝上时,要求所述超声波发射模块和超声波接收模块朝向两脚内侧,第一磁罗盘和第二磁罗盘朝向人行走的正前方即朝向人脚趾头方向,更优选地,分别套在两脚踝的两脚环上的无线电发射模块和无线电接收模块在穿戴时要相互对准。
需要说明的是,请参考图6、7,超声波收发模块(发射模块和接收模块)具有方向性强,发射角度有限的特点,本发明超声波收发模块的收发角度优选为水平面收发角度为100~180°,竖直面收发角度为100~180°,更优选地,水平面收发角度为180°,竖直面收发角度为180°;可根据实际情况,选择设定合适的水平面收发角度和竖直面收发角度,如当用于正常行走状态时,水平面收发角度优选为100°,竖直面收发角度优选为100°;当用于剧烈运动状态是,水平面收发角度优选为180°,竖直面收发角度优选为180°。本发明优选采用多个收发传感器进行TDOA测距,使得超声波信号收发角度尽可能大,更优选低,采用四组超声波收发模块;还可以是,采用一个超声波收发模块,其靠近所述无线电收发模块;但不局限于此,超声波收发模块的数量跟安装角度,是根据超声波收发模块的型号跟参数变化的。
在本实施例中,所述Zigbee通信模块可安装在所述右脚环或左脚环上,优选安装在所述右脚环。可根据使用者的行走习惯,所述左脚环和右脚环可以互换穿戴在右脚踝和左脚踝上,可根据实际情况做选择。所述无线电发射模块和接收模块优选但不限定为Zigbee收发模块,可根据实际情况选择其他无线电收发模块;所述警报模块优选但不限定为震动马达,还可以是蜂鸣声等等。
需要说明的是,所述左右脚环内各模块均采用现有模块,且各模块之间的连接关系,本领域技术人员根据各模块所起到的作用及实际所采用的模块型号容易清楚获得各模块的相互连接关系,在此不再赘述。
所述行人定位装置(监控者定位装置与每一被监控者定位装置)基于脚环获得监控者与被监控者的当前位置坐标并计算获得两者的第一相对距离和方位的方法,包括以下步骤:
(1)监控者定位装置与每一被监控者定位装置基于通信协议相互绑定,每一被监控者定位装置获取的当前位置坐标实时发送至监控者定位装置;
需要说明的是,若是多个被监控者,则就每个被监控者的通信协议上增加唯一码或标记,此为现有技术,不再赘述。
(2)监控者和被监控者穿戴对应的脚环,即监控者定位装置与被监控者定位装置,该行人定位装置可实时获取穿戴者当前的位置坐标,即行人定位装置定位方法,如图8所示,其具体步骤如下:
(2.1)基于超声波收发模块和Zigbee收发模块进行TDOA测距,获得行走周期内两脚之间的实时距离,该步骤具体如下:初始化设置、发送接收超声波信号和无线电信号、第二主控制器的计时器定时计数到达时间差测距。其中,发送超声波和无线电信号时,需保证同时发出两种信号,具体实现时,可按照一定定时周期发送,如每隔50ms发送一次,但不局限于此;无线信号传输速度为,先到达Zigbee接收模块,启动计时器,开始计数;超声波信号传播速度约为,后到达超声波接收模块,到达后触发计时结束,停止计算;将计时时间乘以即为两脚间的距离,实现了人行走时的两脚之间的实时距离。
(2.2)基于双磁罗盘进行航向角检测,该步骤具体如下:初始化设置、kalman滤波误差补偿、双磁罗盘误差矫正。其中双磁罗盘误差矫正涉及人走路时的“八字脚”误差δ,最终航向角取两脚航向角的均值,为均值航向角,以消除行走时的“八字脚”误差δ,如图9所示。
值得注意的是,一般情况下,沿一个方向行走,航向角不变,只有转弯的时候航向角才会变化,但由于双磁罗盘绑在脚踝处会有晃动,在一个行走周期内测得的航向角也对应变化了一个周期。在同一行走周期内,均值航向角与TDOA测的两脚间距是一一对应的,即每一两脚间距对应一个均值航向角。
(2.3)基于步骤(2.1)、(2.2)获得行人航迹的步幅 和运算航向角;具体包括:根据测得行走周期内的实时两脚间距获得步幅变化曲线,该步幅变化曲线由正弦波和方波交替组成;取正弦波的峰值作为当前行走周期行人航迹的步幅,且取步幅最大时刻的航向角(即正弦波峰值时刻对应的航向角)作为运算航向角。由于超声波传播的定向性,且安装于行人脚踝内侧;超声波信号正常接收时,测得的两脚间距呈正弦波变化,而无法接收时,测得的两脚间距呈矩形波变化。在实际行走中,正弦波和方波呈周期性交替出现,如图10所示。
(2.4)将步骤(2.3)的步幅和运算航向角代入行人航迹推算的计算公式即北向坐标:,东向坐标:,即可实现行人轨迹的跟踪定位,即实时更新行人位置坐标;其中,表示行人的初始位置,可以是(0,0),还可以是通过GPS定位获取,其获取方法不局限于此;i表示第i个行走周期;n表示行走n个行走周期。
值得注意的是,步骤(2.1)至(2.4)显示了一个行走周期内进行行人轨迹的跟踪定位方法,具体行走时是连续的行走周期,即重复步骤(2.1)至(2.4),连接每一行走周期的位置坐标即为行人轨迹。
(3)被监控者定位装置获取当前位置坐标发送至监控者定位装置,监控者定位装置接收被监控者的当前位置坐标并计算获得两者的相对距离和方位,即第一相对距离和方位。
需要说明的是,基于磁罗盘进行航向角检测中的kalman滤波误差补偿获得航向角为现有技术,在此不再赘述。
在本发明中,所述监控者可以是老师或家长或导游等,所述被监控者可以是小孩或老人或学生或游客等,但不局限于此。
本发明防丢失监控方法,其基于行人航迹推算获得监控者与被监控者的第一相对距离及基于RSSI算法获得两者的第二相对距离,然后进行判断分析获得两者的当前相对距离,若当前相对距离超出预设安全范围,则发出警报,便于提醒监控者防止危险事故的发生。本方法简单方便、易于实现、安全距离可调、精度高、反应快且可自动报警;本方法所采用的行人定位装置为方便穿戴在监控者和被监控者身上的脚环,即将硬件集成在脚环上,方便拆装且携带方便、抗干扰能力强、可靠性高、稳定性强,且通用性高,无需复杂的安装连接,直接拆装适用于任何人,特别是针对儿童及老人;解决了现有定位方法硬件安装复杂、不便于携带、拆装不便,且干扰性较强、稳定性较弱及无法实现通用性的问题;同时,无惯性漂移的问题,不依赖固定基站,无非视距干扰,可实现室内外自主定位,解决了现有室内外无缝定位时依赖固定基站、惯性漂移及干扰性强的难题,实现了不依赖固定基站环境下对人群进行准确定位;行人定位装置的跟踪范围仅受限于Zigbee的通信范围,一般为1km,远优于现有的20m~50m,故当被监控者超出了预设的安全范围,仍然能进行有效的跟踪定位。
实施例2
如图11所示,一种防丢失监控系统,其包括智能终端、监控者定位装置及至少一被监控者定位装置,所述监控者定位装置与每一被监控者定位装置通信连接,所述智能终端与所述监控者定位装置通信连接,以实时显示两者的当前位置坐标、行走轨迹及两者的当前相对距离和方位,方便监控者实时了解被监控者与其的相对距离,便于监控防止危险事故的发生。所述智能终端还可与每一被监控者定位装置通信连接。
所述每一被监控者定位装置包括分别穿戴在其左右脚踝上的左脚环和右脚环。
如图3、4所示,所述左脚环作为信号发送端,其包括:第一环状承载体1,和设置在所述第一环状承载体1上的无线电发射模块11、超声波发射模块12、第一磁罗盘13、第一主控制器14、第一电池模块15;所述第一环状承载体1具有一开口,俯视状态下呈C形状,但不局限于此;通过该开口穿戴在左脚踝上,所述开口相对处为环状承载体的弧形顶部,所述无线电发射模块11设置在所述第一环状承载体1的弧形顶部处,所述超声波发射模块12靠近所述无线电发射模块11,所述第一磁罗盘13相对所述无线电发射模块11垂直安装在所述第一环状承载体1一侧;所述第一主控制器14分别与所述无线电发射模块11、超声波发射模块12、第一磁罗盘13及第一电池模块15通信连接,主要用于控制各模块及负责同时发送无线电信号和超声波信号;
如图5所示,所述右脚环作为信号接收处理端,其包括:第二环状承载体2,和设置在所述第二环状承载体2上的无线电接收模块21、超声波接收模块22、第二磁罗盘23、第二主控制器24、第二电池模块25、警报模块(图未显示)及无线电通信模块26。所述第二环状承载体2具有一开口,俯视状态下呈C形状,但不局限于此;通过该开口穿戴在右脚踝上,所述开口相对处为环状承载体的弧形顶部,所述无线电接收模块21设置在所述第二环状承载体2的弧形顶部处,所述超声波接收模块22靠近所述无线电接收模块21,所述第二磁罗盘23相对所述无线电接收模块21垂直安装在所述第二环状承载体2一侧;所述第二主控制器24分别与所述无线电接收模块21、超声波接收模块22、第二磁罗盘23、第二电池模块25、警报模块(图未显示)及无线电通信模块26通信连接,主要用于控制各模块及负责接收无线电信号和超声波信号、处理信号并计算获得行人航迹的行人位置坐标。
所述监控者定位装置与被监控者定位装置不同之处在于:第二主控制器还包括数据接收模块、数据处理模块、RSSI测距模块、第一判断模块、第二判断模块;所述数据接收模块分别与每一被监控者定位装置和数据处理模块通信连接,用于接收被监控者的当前位置坐标并发送至所述数据处理模块;所述数据处理模块用于将监控者的当前位置坐标与接收到的被监控者当前位置坐标进行计算获得第一相对距离和方位、还用于根据第一判断模块发送的判断结果获得两者的当前相对距离,若判断结果为不超出预定阈值则将第一相对距离和第二相对距离加权融合作为两者当前相对距离,若判断结果为超出预定阈值则将第一相对距离作为两者当前相对距离;所述RSSI测距模块用于根据接收到的信号的RSSI(接收信号强度指示)值计算两者的相对距离信息,即两者的第二相对距离;所述第一判断模块与所述RSSI测距模块及数据处理模块连接,用于判断所述第二相对距离是否超出预定阈值且将判断结果发送至数据处理模块;所述第二判断模块与所述数据处理模块连接,用于判断所述第一相对距离是否超出预设安全范围。
需要说明的是,请参考图6、7,超声波收发模块(发射模块和接收模块)具有方向性强,发射角度有限的特点,本发明超声波收发模块的收发角度优选为水平面收发角度为100~180°,竖直面收发角度为100~180°,更优选地,水平面收发角度为180°,竖直面收发角度为180°;可根据实际情况,选择设定合适的水平面收发角度和竖直面收发角度,如当用于正常行走状态时,水平面收发角度优选为100°,竖直面收发角度优选为100°;当用于剧烈运动状态是,水平面收发角度优选为180°,竖直面收发角度优选为180°。本发明优选采用多个收发传感器进行TDOA测距,使得超声波信号收发角度尽可能大,更优选低,采用四组超声波收发模块;还可以是,采用一个超声波收发模块,其靠近所述无线电收发模块;但不局限于此,超声波收发模块的数量跟安装角度,是根据超声波收发模块的型号跟参数变化的。
在本实施例中,所述Zigbee通信模块可安装在所述右脚环或左脚环上,优选安装在所述右脚环。可根据使用者的行走习惯,所述左脚环和右脚环可以互换穿戴在右脚踝和左脚踝上,可根据实际情况做选择。所述无线电发射模块和接收模块优选但不限定为Zigbee收发模块,可根据实际情况选择其他无线电收发模块;所述警报模块优选但不限定为震动马达,还可以是蜂鸣声等等。所述RSSI测距模块是基于RSSI测距原理进行测距,其为现有技术,容易实现,在此不再赘述。
需要说明的是,所述左右脚环内各模块均采用现有模块,且各模块之间的连接关系,本领域技术人员根据各模块所起到的作用及实际所采用的模块型号容易清楚获得各模块的相互连接关系,在此不再赘述。
本发明防丢失监控系统,其基于行人航迹推算获得监控者与被监控者的第一相对距离及基于RSSI算法获得两者的第二相对距离,然后进行判断分析获得两者的当前相对距离,若当前相对距离超出预设安全范围,则发出警报,便于提醒监控者并防止危险事故的发生;简单方便、易于实现、安全距离可调、精度高、反应快且可自动报警;所使用的行人定位装置为方便穿戴在监控者和被监控者身上的脚环,即将硬件集成在脚环上,方便拆装且携带方便、抗干扰能力强、可靠性高、稳定性强,且通用性高,无需复杂的安装连接,直接拆装适用于任何人,特别是针对儿童及老人;解决了现有定位方法硬件安装复杂、不便于携带、拆装不便,且干扰性较强、稳定性较弱及无法实现通用性的问题;同时,无惯性漂移的问题,不依赖固定基站,无非视距干扰,可实现室内外自主定位,解决了现有室内外无缝定位时依赖固定基站、惯性漂移及干扰性强的难题,实现了不依赖固定基站环境下对人群进行准确定位;行人定位装置的跟踪范围仅受限于Zigbee的通信范围,一般为1km,远优于现有的20m~50m,故当被监控者超出了预设的安全范围,仍然能进行有效的跟踪定位。
以上所述实施例仅表达了本发明的实施方式,其描述较为具体和详细,但并不能因此而理解为对本发明专利范围的限制,但凡采用等同替换或等效变换的形式所获得的技术方案,均应落在本发明的保护范围之内。
Claims (9)
1.一种防丢失监控方法,其包括以下步骤:
(1)监控者定位装置和至少一被监控者定位装置获得各自的当前位置坐标,监控者定位装置接收每一被监控者定位装置发送的位置坐标信号并计算获得两者的第一相对距离和方位;
(2)监控者定位装置根据接收到的信号强弱计算两者的第二相对距离,其基于RSSI测距算法获得;
(3)判断第二相对距离是否超过预定阈值;若低于预定阈值,则将第一相对距离和第二相对距离进行加权计算获得两者的当前相对距离与所述方位一并发送至智能终端,且进入步骤(4);若超过预定阈值,则将第一相对距离作为两者的当前相对距离与所述方位一并发送至智能终端,且进入步骤(4);
(4)判断当前相对距离是否超过预设安全范围,若不超出预设安全范围,则返回步骤(1);若超出预设安全范围,则监控者定位装置和被监控者定位装置均发出警报;
所述步骤(1)具体包括以下步骤:
(1.1)监控者定位装置与至少一被监控者定位装置相互绑定,每一被监控者定位装置获取的当前位置坐标实时发送至监控者定位装置;
(1.2)监控者和被监控者分别穿戴监控者定位装置与被监控者定位装置,监控者定位装置与被监控者定位装置获取对应穿戴者的当前位置坐标,具体步骤如下:
(2.1)基于超声波收发模块和无线电收发模块进行TDOA测距,获得行走周期内两脚之间的实时距离;
(2.2)基于双磁罗盘进行航向角检测;
(2.3)基于步骤(2.1)、(2.2)获得行人航迹的步幅和运算航向角;
(2.4)将步骤(2.3)的步幅和运算航向角代入行人航迹推算的计算公式即北向坐标:,东向坐标:,即当前行人位置坐标;其中,表示行人的初始位置,i表示第i个行走周期,n表示行走n个行走周期;
(1.3)被监控者定位装置发送当前位置坐标至监控者定位装置,监控者定位装置接收被监控者的当前位置坐标并计算获得两者的相对距离和方位,即第一相对距离和方位。
2.根据权利要求1所述的防丢失监控方法,其特征在于,所述预定阈值为5~15m。
3.根据权利要求1所述的防丢失监控方法,其特征在于,进行加权计算时,所述第一相对距离的加权比重为0~50%,所述第二相对距离的加权比重为50~100%。
4.根据权利要求1所述的防丢失监控方法,其特征在于,所述每一被监控者定位装置包括左右脚环;所述左脚环作为信号发送端,包括第一主控制器,与所述第一主控制器连接的无线电发射模块、超声波发射模块、第一磁罗盘,所述第一主控制器主要用于控制各模块及负责同时发送无线电信号和超声波信号;所述右脚环作为信号接收处理端,包括第二主控制器,与所述第二主控制器连接的无线电接收模块、超声波接收模块、第二磁罗盘、无线通信模块及警报模块,所述第二主控制器主要用于控制各模块及负责接收无线电信号和超声波信号、处理信号并计算获得行人航迹的行人位置坐标;
所述监控者定位装置与被监控者定位装置不同之处在于:所述第二主控制器还包括数据处理模块、RSSI测距模块、第一判断模块、第二判断模块;所述数据处理模块用于根据监控者定位装置的当前位置坐标与接收到的被监控者定位装置的当前位置坐标计算获得两者的第一相对距离和方位、还用于根据第一判断模块发送的判断结果获得两者的当前相对距离;所述RSSI测距模块用于根据接收信号的强弱计算监控者定位装置与被监控者定位装置之间的第二相对距离;所述第一判断模块与所述RSSI测距模块及数据处理模块连接,用于判断所述第二相对距离是否超出预定阈值且将判断结果发送至数据处理模块;所述第二判断模块与所述数据处理模块连接,用于判断所述第一相对距离是否超出预设安全范围。
5.根据权利要求4所述的防丢失监控方法,其特征在于,所述超声波发射模块和超声波接收模块组成超声波收发模块;将所述左右脚环穿戴在脚踝上时,所述超声波收发模块朝向两脚内侧,双磁罗盘朝向人行走的正前方。
6.根据权利要求4所述的防丢失监控方法,其特征在于,所述无线电发射模块和无线电接收模块在穿戴时要相互对准。
7.根据权利要求4所述的防丢失监控方法,其特征在于,所述超声波发射模块和超声波接收模块组成超声波收发模块;所述超声波收发模块的水平面收发角度为100~180°,竖直面收发角度为100~180°。
8.一种定位装置,其特征在于,其包括左右脚环;所述左脚环作为信号发送端,包括第一主控制器,与所述第一主控制器连接的无线电发射模块、超声波发射模块、第一磁罗盘,所述第一主控制器主要用于控制各模块及负责同时发送无线电信号和超声波信号;所述右脚环作为信号接收处理端,包括第二主控制器,与所述第二主控制器连接的无线电接收模块、超声波接收模块、第二磁罗盘、无线通信模块及警报模块,所述第二主控制器主要用于控制各模块及负责接收无线电信号和超声波信号、处理信号并计算获得行人航迹的行人位置坐标。
9.根据权利要求8所述的定位装置,其特征在于,所述第二主控制器还包括数据处理模块、RSSI测距模块、第一判断模块、第二判断模块;所述数据处理模块用于根据本定位装置的当前位置坐标与接收到的其他定位装置的当前位置坐标计算获得两者的第一相对距离和方位、还用于根据第一判断模块发送的判断结果获得两者的当前相对距离;所述RSSI测距模块用于根据接收信号的强弱计算本定位装置与其他定位装置之间的第二相对距离;所述第一判断模块与所述RSSI测距模块及数据处理模块连接,用于判断所述第二相对距离是否超出预定阈值且将判断结果发送至数据处理模块;所述第二判断模块与所述数据处理模块连接,用于判断所述第一相对距离是否超出预设安全范围。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610253428.6A CN105785352B (zh) | 2016-04-22 | 2016-04-22 | 一种防丢失监控方法及定位装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610253428.6A CN105785352B (zh) | 2016-04-22 | 2016-04-22 | 一种防丢失监控方法及定位装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105785352A CN105785352A (zh) | 2016-07-20 |
CN105785352B true CN105785352B (zh) | 2018-03-09 |
Family
ID=56398093
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610253428.6A Expired - Fee Related CN105785352B (zh) | 2016-04-22 | 2016-04-22 | 一种防丢失监控方法及定位装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105785352B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106571018A (zh) * | 2016-09-26 | 2017-04-19 | 珠海格力电器股份有限公司 | 防止物品丢失的方法、装置及具有该装置的物品 |
CN106595651A (zh) * | 2016-11-24 | 2017-04-26 | 歌尔科技有限公司 | 监控终端、防丢终端、防丢系统和防丢方法 |
CN107103727B (zh) * | 2017-06-12 | 2020-10-02 | 广东小天才科技有限公司 | 蓝牙报警方法及装置 |
WO2018227331A1 (zh) * | 2017-06-12 | 2018-12-20 | 深圳市乃斯网络科技有限公司 | 终端的绑定设备的定位分享方法及系统 |
CN107613464A (zh) * | 2017-10-30 | 2018-01-19 | 云南民族大学 | 一种无线传感器网络定位系统 |
CN108562291A (zh) * | 2018-01-30 | 2018-09-21 | 厦门盈趣科技股份有限公司 | 物件寻找方法、装置及终端设备 |
CN109089222A (zh) * | 2018-07-18 | 2018-12-25 | 奇酷互联网络科技(深圳)有限公司 | 移动终端和监护方法、装置 |
CN114513753A (zh) * | 2022-01-28 | 2022-05-17 | 青岛海信移动通信技术股份有限公司 | 一种终端设备、轨迹监控方法和存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102026369A (zh) * | 2009-09-10 | 2011-04-20 | 摩托罗拉公司 | 用于确定目标装置的位置的方法和定位服务器 |
JP2012083323A (ja) * | 2010-09-15 | 2012-04-26 | Casio Comput Co Ltd | 測位装置、測位方法およびプログラム |
CN103152761A (zh) * | 2013-03-06 | 2013-06-12 | 中国人民解放军国防科学技术大学 | 一种测距参数可消减的干扰源定位方法 |
CN104111452A (zh) * | 2014-06-12 | 2014-10-22 | 京东方科技集团股份有限公司 | 无线距离监测设备 |
CN104616458A (zh) * | 2015-01-30 | 2015-05-13 | 朱威 | 一种物品防丢失方法及系统 |
-
2016
- 2016-04-22 CN CN201610253428.6A patent/CN105785352B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102026369A (zh) * | 2009-09-10 | 2011-04-20 | 摩托罗拉公司 | 用于确定目标装置的位置的方法和定位服务器 |
JP2012083323A (ja) * | 2010-09-15 | 2012-04-26 | Casio Comput Co Ltd | 測位装置、測位方法およびプログラム |
CN103152761A (zh) * | 2013-03-06 | 2013-06-12 | 中国人民解放军国防科学技术大学 | 一种测距参数可消减的干扰源定位方法 |
CN104111452A (zh) * | 2014-06-12 | 2014-10-22 | 京东方科技集团股份有限公司 | 无线距离监测设备 |
CN104616458A (zh) * | 2015-01-30 | 2015-05-13 | 朱威 | 一种物品防丢失方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN105785352A (zh) | 2016-07-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105785352B (zh) | 一种防丢失监控方法及定位装置 | |
US6414629B1 (en) | Tracking device | |
CN102419180B (zh) | 一种基于惯性导航系统和wifi的室内定位方法 | |
CN102209386B (zh) | 一种室内无线定位方法及装置 | |
CN104457750B (zh) | 一种应急救援的人员定位系统及方法 | |
CN105783920A (zh) | 一种室内外定位方法及定位系统、定位用脚环 | |
CN103994767A (zh) | 一种救援人员室内协同定位装置及方法 | |
CN109470238A (zh) | 一种定位方法、装置和移动终端 | |
CN106937377B (zh) | 一种针对监测目标实现分级定位的方法、装置及设备 | |
CN103599632B (zh) | 高尔夫训练智能辅助系统 | |
CN107302754A (zh) | 一种基于WiFi与PDR的室内定位简易方法 | |
CN110986952B (zh) | 一种针对行人的高精度抗干扰室内定位方法 | |
CN109100768A (zh) | 一种综合定位方法及定位标签 | |
US20210258733A1 (en) | Method and system for determining and tracking an indoor position of an object | |
CN114501300A (zh) | 一种基于空间环境误差模型的分布式定位算法 | |
KR102134506B1 (ko) | 실내외 연속 위치측정 시스템 | |
CN111487587A (zh) | 一种基于超带宽定位的危岩崩塌灾害变形监测方法及系统 | |
CN113325455B (zh) | 用于跟踪和确定物体的室内位置的方法和系统 | |
CN104237846A (zh) | 自主式移动对象室内三维定位跟踪系统与方法 | |
CN205541339U (zh) | 一种防丢失监控系统及定位装置 | |
CN107607108A (zh) | 一种室内移动目标的定位设备 | |
CN109407079A (zh) | 一种基于姿态传感器校准的区域定位装置及方法 | |
CN109297495B (zh) | 一种行人导航定位方法和行人导航定位系统 | |
CN203989784U (zh) | 高尔夫训练智能辅助系统 | |
CN206369546U (zh) | 一种基于智能手机的混合定位系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180309 Termination date: 20190422 |