室内目标运行轨迹识别系统转让专利
申请号 : CN202110663315.4
文献号 : CN113259855B
文献日 : 2021-10-01
发明人 : 梁栋
申请人 : 北京奇岱松科技有限公司
摘要 :
权利要求 :
1.一种室内目标运行轨迹识别系统,其特征在于,包括服务器和用于佩戴人体上的定位标签,其中,所述服务器包括预先构建的语义地图、第一数据库、处理器和存储有计算机程序的存储器,所述定位标签包括定位设备;当所述处理器在执行所述计算机程序时,实现以下步骤:步骤S1、实时接收所述定位标签的定位设备每间隔预设第一时间间隔上报的原始位置信息,将所述原始位置信息转换为相对于所述语义地图的地图位置信息,并按上报时间顺序存储至所述第一数据库中;
步骤S2、从所述第一数据库中获取距离当前时刻最近的N个地图位置信息{S1,S2,…SN},其中,S1,S2,…SN按照上报时间距离当前时刻的时间间隔从小到大的顺序排序,Si表示距离当前时刻最近的第i个地图位置信息,i=1,2,…N;
步骤S3、基于{S1,S2,…SN}判断距离当前时刻最近的N个地图位置在所述语义地图上的轨迹是否为目标运行轨迹,所述目标运行轨迹为预设直线轨迹;
所述定位标签还包括加速度计,当所述服务器实时接收所述定位标签的定位设备上报的原始位置信息时,同时接收所述加速度计上报的原始加速度信息,并将所述原始加速度信息转换为相对于所述语义地图的地图偏角信息,所述地图偏角信息为加速度计相对于所述语义地图X轴的偏角信息,并按上报时间顺序存储至所述第一数据库中;
当所述步骤S3基于{S1,S2,…SN}判断距离当前时刻最近的N个地图位置在所述语义地图上的轨迹为预设直线轨迹后,还包括:步骤S4、获取{S1,S2,…SN}对应的N个地图偏角信息{θ1,θ2,…θN},θi表示距离当前时刻最近的第i个地图偏角信息,i=1,2,…N,获取∣θ1‑θN∣,并判断∣θ1‑θN∣是否小于等于预设的第一角度差,若是,则直接执行步骤S43,否则,执行步骤S42;
步骤S42、判断∣θ1‑θN∣是否小于等于预设的第二角度差,若是,则基于{θ1,θ2,…θN}更新当前初始化方向绑定角∂,否则,确定所述定位标签从θ1对应的上报时间到θN对应的上报时间的时间段内发生了翻转,基于{θ1,θ2,…θN}确定翻转点对应的地图偏角θk,再基于{θ1,θ2,…θk}更新当前初始化方向绑定角∂,其中,所述初始化方向绑定角为人体与定位标签的初始化方向绑定角;
步骤S43、基于θ1、θ2、∂确定佩戴所述定位标签的人员基于所述语义地图的当前人体朝向角Φ1=θ1‑θ2+∂,其中,∂为当前初始化方向绑定角。
2.根据权利要求1所述的系统,其特征在于,所述语义地图被划分为若干网格,每一网格的状态值为1或0,网格状态值为0表示对应位置能够行走,网格状态值为1表示对应位置不能行走,每一所述地图位置信息对应所述语义地图一个网格。
3.根据权利要求2所述的系统,其特征在于,所述网格为正方形网格,所述网格边长基于所述语义地图预设的定位分辨率设定。
4.根据权利要求3所述的系统,其特征在于,所述步骤S3包括:
步骤S31、获取每一S1,S2,…SN中每一地图位置信息对应的网格位置点,每一地图位置信息在对应的网格位置点相对于网格的位置相同,判断S1,S2,…SN对应的网格位置点是否在一条直线上,若是,则确定距离当前时刻最近的N个地图位置在所述语义地图上的轨迹符合预设直线轨迹。
5.根据权利要求3所述的系统,其特征在于,所述步骤S3包括:
步骤S311、基于S1对应的网格位置点和SN对应的网格位置点在所述语义地图上确定参考直线,每一地图位置信息在对应的网格位置点相对于网格的位置相同;
步骤S312、基于Si对应的网格位置点和Si+1对应的网格位置点在所述语义地图上确定第i直线,并获取第i直线和所述参考直线的第i夹角,若所述第i夹角均小于等于预设的夹角阈值,则判断距离当前时刻最近的N个地图位置在所述语义地图上的轨迹符合预设直线轨迹。
6.根据权利要求5所述的系统,其特征在于,所述夹角阈值小于等于45°。
7.根据权利要求1所述的系统,其特征在于,所述服务器还包括第二数据库,用于存储室内障碍物位置信息,所述障碍物位置指的是室内人员无法通行的位置,所述系统还包括能够动态扫描室内障碍物位置的信息获取设备,当所述处理器在执行所述计算机程序时,实现以下步骤:步骤S10、接收所述信息获取设备上报的当前室内障碍物位置信息,并存储到所述第二数据库中;
步骤S20、每间隔预设的第二时间间隔,基于所述第二数据库中当前时刻室内障碍物的位置信息更新所述语义地图。
8.根据权利要求1所述的系统,其特征在于,所述定位设备为室内无线定位设备。
说明书 :
室内目标运行轨迹识别系统
技术领域
背景技术
基于现有的显示地图无法准确识别人体所在的位置,更无法准确识别人体运行轨迹。由此
可知,如何快度准确识别人体在室内的运行轨迹成为亟待解决的技术问题。
发明内容
和存储有计算机程序的存储器,所述定位标签包括定位设备;当所述处理器在执行所述计
算机程序时,实现以下步骤:
间顺序存储至所述第一数据库中;
表示距离当前时刻最近的第i个地图位置信息,i=1,2,…N;
的广泛利用价值,其至少具有下列优点:
更明显易懂,以下特举较佳实施例,并配合附图,详细说明如下。
附图说明
具体实施方式
及其功效,详细说明如后。
步骤可以被并行地、并发地或者同时实施。此外,各步骤的顺序可以被重新安排。当其操作
完成时处理可以被终止,但是还可以具有未包括在附图中的附加步骤。处理可以对应于方
法、函数、规程、子例程、子程序等等。
理器和存储有计算机程序的存储器,所述定位标签包括定位设备;当定位标签佩戴在人体
上后,定位标签的原始位置信息和原始加速度信息会随着人体的运动发生变化。需要说明
的是,语义地图是根据室内环境构建的室内含义的地图,其中包含了什么地方能够以通行,
什么地方有障碍物,什么地方可以站人、坐人等信息。定位标签的定位设备具体可采用蜂窝
定位技术、Wi‑Fi、蓝牙、红外线、超宽带(UWB)、射频识别(RFID)、ZigBee、动作捕捉和超声波
等室内定位技术进行定位。所述加速度计具体可为iMU(Inertial measurement unit,惯性
测量单元),iMU是测量物体三轴姿态角(或角速率)以及加速度的装置,本发明实施例仅使
用iMU采集的加速度信息即可。
间顺序存储至所述第一数据库中;
义地图的映射关系,能够将原始位置信息转换为相对于所述语义地图的地图位置信息。
表示距离当前时刻最近的第i个地图位置信息,i=1,2,…N;
方向绑定角,这种场景下对人体的运行轨迹是否为直线的准确度要求较高。所述语义地图
被划分为若干网格,每一网格的状态值为1或0,网格状态值为0表示对应位置能够行走,网
格状态值为1表示对应位置不能行走,每一所述地图位置信息对应所述语义地图一个网格。
进一步的,所述网格为正方形网格,所述网格边长基于所述语义地图预设的定位分辨率设
定。
是否在一条直线上,若是,则确定距离当前时刻最近的N个地图位置在所述语义地图上的轨
迹符合预设直线轨迹。
忍范围内的位置抖动也确定为在预设直线轨迹上,具体的,作为一种实施例,所述步骤S3包
括:
均小于等于预设的夹角阈值,则判断距离当前时刻最近的N个地图位置在所述语义地图上
的轨迹符合预设直线轨迹。
存储室内障碍物位置信息,所述障碍物位置指的是室内人员无法通行的位置,所述系统还
包括能够动态扫描室内障碍物位置的信息获取设备,当所述处理器在执行所述计算机程序
时,实现以下步骤:
实时接收所述定位标签的定位设备上报的原始位置信息时,同时接收所述加速度计上报的
原始加速度信息,并将所述原始加速度信息转换为相对于所述语义地图的地图偏角信息,
所述地图偏角信息为加速度计相对于所述语义地图X轴的偏角信息,并按上报时间顺序存
储至所述第一数据库中;需要说明的是,基于加速度计能够通过现有的几何运算解算出相
对于显示地图X轴Y轴建立空间内的加速度分量,再基于重力g可以解算出相对于显示地图X
轴的偏角,从而得到相对于所述语义地图的地图偏角信息。
初始化方向绑定角∂,再基于θ1、θ2、∂确定佩戴所述定位标签的人员基于所述语义地图的当
前人体朝向角Φ1=θ1‑θ2+∂,其中,∂为当前初始化方向绑定角。
所述语义地图X轴与所述显示地图X轴夹角不为0时,假设所述显示线图的X轴和所述语义地
图的X轴的夹角为β,则所述步骤S4还包括:
所述显示地图的当前人体朝向角Φ2=Φ1+β。
转的标签,定位标签还可以通过线绳佩戴在人体脖子上或者放在口袋中的方式佩戴,这种
情况下,如果定位标签发生了较大幅度的转动,例如,将定为标签安装在胸卡上,人体行动
过程中胸卡翻转,会造成定位标签的翻转。当定位标签具体是佩戴相对固定定位标签时,随
着时间推移,可能出现系统累计误差,因此,当误差达到一定程度时,且满足人体沿预设直
线轨迹行走时,可以重新初始化当前初始化方向绑定角,从而提升人体朝向角的计算精确
度。而对于可能发生反转的情况,当发生反转时,也需要重新始化当前初始化方向绑定角。
基于此,作为一种实施例,步骤S4进一步可包括:
出现累计误差,因此,设置用于表征系统误差的第一角度差,优选的,所述第一角度差可以
设置为小于等于10°,
报时间的时间段内发生了翻转,基于{θ1,θ2,…θN}确定翻转点对应的地图偏角θk,再基于
{θ1,θ2,…θk}更新当前初始化方向绑定角∂,其中,所述初始化方向绑定角为人体与定位标
签的初始化方向绑定角;
度差,结合第一角度差来判断定位标签是否发生了翻转,然后再进一步根据具体情况来获
取初始化方向绑定角。所述第一角度差可设置为小于等于10°,所述第二角度差可设置为大
于10°小于等于45°。作为一种实施例,所述第一角度差可设置为10°,第二角度差设置为
45°。通过重新更新初始化方向绑定角∂,从而提高系统获取人体朝向角的精确度。可以理解
的是,在最开始佩戴上定位标签时,首次获取初始化方向绑定角时,无需执行步骤S3,也无
需执行步骤S4中判断∣θ1‑θN∣是否小于等于预设的第二角度差,直接基于{θ1,θ2,…θN}获取
当前初始化方向绑定角∂。在实际使用场景中,为了尽快获取一个初始化方向绑定角,可以
在室内入口设置一段预设距离的直线路径,使得尽快能够获取初始化方向绑定角,从而尽
快计算出人体朝向角。
线轨迹的判断以及定义标签角度来确定人的朝向角,不用完全依赖摄像头采集信息,能够
全面覆盖室内定位区域的人体朝向计算,基于语义地图结合位置信息和角度信息获取人体
朝向角,即便在室内人群拥挤、环境复杂的场景下,也可使用。且能够通过判断定位标签是
否翻转以及累积误差是否过大来动态更新人体和定位标签的初始化方向绑定角,减小系统
误差的影响,提高了系统的鲁棒性。且基于加速度计获取角度信息,不会受到磁场的影响,
提高了室内人体朝向识别的准确度。此外,本发明实施例无需采用复杂的深度神经网络,降
低了算力要求,从而节省了成本。
前初始化方向绑定角∂,包括:
实施例,所述步骤S42中,所述基于{θ1,θ2,…θN}更新当前初始化方向绑定角∂,包括:
向绑定角∂,包括:
定翻转点对应的地图偏角θk,包括:
S42中,所述基于{θ1,θ2,…θk}更新当前初始化方向绑定角∂,包括:
员,在不脱离本发明技术方案范围内,当可利用上述揭示的技术内容作出些许更动或修饰
为等同变化的等效实施例,但凡是未脱离本发明技术方案的内容,依据本发明的技术实质
对以上实施例所作的任何简单修改、等同变化与修饰,均仍属于本发明技术方案的范围内。