CN106595633B - Indoor positioning method and device - Google Patents
Indoor positioning method and device Download PDFInfo
- Publication number
- CN106595633B CN106595633B CN201611070529.6A CN201611070529A CN106595633B CN 106595633 B CN106595633 B CN 106595633B CN 201611070529 A CN201611070529 A CN 201611070529A CN 106595633 B CN106595633 B CN 106595633B
- Authority
- CN
- China
- Prior art keywords
- pedestrian
- indoor
- probability
- position information
- movement
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 66
- 238000005070 sampling Methods 0.000 claims description 101
- 230000001133 acceleration Effects 0.000 claims description 65
- 239000011159 matrix material Substances 0.000 claims description 12
- 238000005516 engineering process Methods 0.000 abstract description 20
- 238000013461 design Methods 0.000 abstract description 3
- 238000009434 installation Methods 0.000 abstract 1
- 230000008569 process Effects 0.000 description 22
- 238000004364 calculation method Methods 0.000 description 19
- 238000006073 displacement reaction Methods 0.000 description 6
- 238000001514 detection method Methods 0.000 description 5
- 230000007774 longterm Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 238000012549 training Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 230000008520 organization Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000474 nursing effect Effects 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
技术领域technical field
本发明涉及室内定位技术领域,更具体地,涉及一种室内定位方法及装置。The present invention relates to the technical field of indoor positioning, and more particularly, to an indoor positioning method and device.
背景技术Background technique
在目前许多应用领域中,获取人或者物体位置信息都非常重要。随着科学技术以及通信技术等不断进步,基于LBS(Location Based Service,位置服务)的定位技术也迅猛发展。LBS主要解决的问题是将已经存在的资源提供给用户,根据其所处的周边环境来提供特定的服务。In many current application fields, it is very important to obtain the position information of people or objects. With the continuous progress of science and technology and communication technology, the positioning technology based on LBS (Location Based Service, location service) is also developing rapidly. The main problem solved by LBS is to provide existing resources to users and provide specific services according to their surrounding environment.
在室外环境下,可通过GPS(Global Positioning System,全球定位系统)来获得位置信息。随着信息技术飞速发展,GPS定位技术可以满足普通民众的日常需求。相应地,GPS技术一直是研究的主流。由于GPS是通过卫星来进行定位的,在四颗卫星同时定位的前提下才可以获得到最好的定位精度。但是在室内的环境下,由于建筑物对GPS信号的遮挡,卫星信号强度和质量急速下降。同时,由于室内环境十分复杂,在室内不能进行精确地定位。因此,室内定位技术难度较大。In an outdoor environment, position information can be obtained through GPS (Global Positioning System, global positioning system). With the rapid development of information technology, GPS positioning technology can meet the daily needs of ordinary people. Accordingly, GPS technology has always been the mainstream of research. Since GPS is positioned by satellites, the best positioning accuracy can be obtained only when four satellites are positioned at the same time. However, in an indoor environment, the strength and quality of satellite signals drop rapidly due to the obstruction of GPS signals by buildings. At the same time, because the indoor environment is very complex, accurate positioning cannot be performed indoors. Therefore, indoor positioning technology is more difficult.
另外,研究表明人们日常生活中90%时间都在室内,也就是说人们大部分时间都在GPS信号定位之外。由此可见,室内定位技术也是人们所着重需求的。随着智能通信设备的发展,室内定位技术的研究也发展了起来。人们日常生活中使用的智能手机和平板电脑等智能移动终端,集成了MEMS(Micro-Electro-Mechanical System,微机电系统)、加速度计、陀螺仪及气压计等高精度传感器元件。这些传感器元件的广泛使用,为室内定位技术提供了基础且传感器元件的精度也可以满足室内定位技术的需求。另外,辅助定位技术也同时获得广泛而充分的研究。例如,基于无线指纹信号的室内定位技术、基于视觉的定位技术等。这些方式或者是与传感器结合使用,或者作为独立的定位技术。相应地,室内定位的精度也随之提高。近年来,谷歌等公司开始建立室内地图,逐步覆盖了一些大城市的标志性建筑物,从而使得室内的地图也可以成为定位的辅助手段。In addition, research shows that people spend 90% of their daily lives indoors, which means they spend most of their time outside of GPS signals. It can be seen that indoor positioning technology is also a key demand of people. With the development of intelligent communication equipment, the research of indoor positioning technology has also developed. Smart mobile terminals such as smart phones and tablet computers used in people's daily life integrate high-precision sensor elements such as MEMS (Micro-Electro-Mechanical System, Micro-Electro-Mechanical System), accelerometers, gyroscopes, and barometers. The extensive use of these sensor elements provides a basis for indoor positioning technology and the accuracy of the sensor elements can also meet the needs of indoor positioning technology. In addition, assisted positioning technology has also been widely and fully studied at the same time. For example, indoor positioning technology based on wireless fingerprint signals, vision-based positioning technology, etc. These approaches are used either in conjunction with sensors or as stand-alone positioning techniques. Accordingly, the accuracy of indoor positioning is also improved. In recent years, companies such as Google have begun to build indoor maps, gradually covering the iconic buildings in some big cities, so that indoor maps can also become an auxiliary means of positioning.
从2000年开始,在智能终端逐渐普及的基础上,LBS在渐渐地被应用在紧急救助、灾害预防、物流管理、设备检查及医疗保健等领域。在这个背景下,对于定位从室外到室内的无缝连接需求也被提了出来。Since 2000, on the basis of the gradual popularization of intelligent terminals, LBS has been gradually applied in the fields of emergency rescue, disaster prevention, logistics management, equipment inspection and medical care. In this context, the need for seamless connection from outdoor to indoor positioning is also raised.
在公共安全保障、商业化服务以及在仓储服务领域中,高精度的室内定位技术有着非常重要的意义。例如,在社会公共安全保障方面,精准的室内定位技术可以为消防员、警察等人员提供室内导航服务,以及在监狱中对犯人进行定位等。在商业化服务中,精准的室内定位技术可以为家庭提供定位服务,在商场、博物馆等室内环境中可提供导航,在医院、家庭中可以提供对于老人、小孩以及病人的看护定位服务。在仓储服务中,可以对物品进行定位。因此,室内定位技术拥有广泛的应用场景。In the field of public security, commercial services and warehousing services, high-precision indoor positioning technology is of great significance. For example, in terms of social and public security, accurate indoor positioning technology can provide indoor navigation services for firefighters, police and other personnel, and locate prisoners in prisons. In commercial services, accurate indoor positioning technology can provide positioning services for families, provide navigation in indoor environments such as shopping malls and museums, and provide nursing positioning services for the elderly, children and patients in hospitals and families. In warehousing services, items can be located. Therefore, indoor positioning technology has a wide range of application scenarios.
在此基础上,行人室内定位和导航技术的研究方向主要是向着低成本、易便携及提高定位精度发展。现有的室内定位方法主要是预先安装多个外部设备,如AP(AcessPiont,接入点),根据移动终端与外部设备之间信号强度与距离的映射关系,来对行人进行定位。On this basis, the research direction of pedestrian indoor positioning and navigation technology is mainly to develop towards low cost, easy portability and improved positioning accuracy. The existing indoor positioning method mainly pre-installs multiple external devices, such as AP (AccessPiont, access point), and locates pedestrians according to the mapping relationship between the signal strength and the distance between the mobile terminal and the external device.
在实现本发明的过程中,发现现有技术至少存在以下问题:由于需要安装多个外部设备,设备成本耗费较高。另外,多个外部设备之间通常需要设计复杂度较高的系统来协同工作。因此,室内定位时耗费的成本较高。In the process of implementing the present invention, it is found that the prior art has at least the following problems: due to the need to install multiple external devices, the cost of the device is relatively high. In addition, a system with high design complexity is usually required to work together among multiple external devices. Therefore, the cost of indoor positioning is relatively high.
发明内容SUMMARY OF THE INVENTION
本发明提供一种克服上述问题或者至少部分地解决上述问题的室内定位方法及装置。The present invention provides an indoor positioning method and device that overcomes the above problems or at least partially solves the above problems.
根据本发明的一方面,提供了一种室内定位方法,该方法包括:According to an aspect of the present invention, an indoor positioning method is provided, the method comprising:
根据多重传感器采集到的数据,预测行人的位置信息;According to the data collected by multiple sensors, predict the location information of pedestrians;
基于室内运动模型,获取行人的室内运动状态;Obtain the indoor motion state of pedestrians based on the indoor motion model;
基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。Based on the indoor environment map model, the predicted pedestrian position information is calibrated according to the indoor motion state and the position information of the indoor preset nodes, and the final position information of the pedestrian is obtained.
根据本发明的另一方面,提供了一种室内定位装置,该装置包括:According to another aspect of the present invention, an indoor positioning device is provided, the device comprising:
预测模块,用于根据多重传感器采集到的数据,预测行人的位置信息;The prediction module is used to predict the location information of pedestrians according to the data collected by multiple sensors;
获取模块,用于基于室内运动模型,获取行人的室内运动状态;The acquisition module is used to acquire the indoor motion state of pedestrians based on the indoor motion model;
校准模块,用于基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。The calibration module is used for calibrating the predicted pedestrian position information based on the indoor environment map model, according to the indoor motion state and the position information of the indoor preset nodes, to obtain the final position information of the pedestrian.
本申请提出的技术方案带来的有益效果是:The beneficial effects brought by the technical solution proposed by the application are:
通过根据多重传感器采集到的数据,预测行人的位置信息。基于室内运动模型,获取行人的室内运动状态。基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。由于不用安装外部设备,从而在避免设计复杂度较高的系统的同时,还可减少硬件成本消耗,进而使得室内定位时耗费的成本较低。The location information of pedestrians is predicted based on the data collected by multiple sensors. Based on the indoor motion model, the indoor motion state of the pedestrian is obtained. Based on the indoor environment map model, the predicted pedestrian position information is calibrated according to the indoor motion state and the position information of the indoor preset nodes, and the final position information of the pedestrian is obtained. Since there is no need to install external equipment, while avoiding designing a system with high complexity, the hardware cost consumption can also be reduced, so that the cost of indoor positioning is lower.
另外,由于进行运动特征分类时,选取了加速度计、气压计和陀螺仪数据,提高了运动特征分类时的准确性,同时能够避免长时间累积误差的出现。由于定位过程将行人航位推测算法、室内行人运动特征以及隐马尔科夫模型匹配方法结合在了一起,从而在保证较高定位准确率的同时,还可以提升室内定位的鲁棒性。In addition, the accelerometer, barometer and gyroscope data are selected during the classification of motion features, which improves the accuracy of classification of motion features and avoids the occurrence of long-term accumulated errors. Since the positioning process combines the pedestrian dead reckoning algorithm, the indoor pedestrian motion feature and the hidden Markov model matching method, the robustness of indoor positioning can be improved while ensuring a high positioning accuracy.
附图说明Description of drawings
图1为本发明实施例的一种室内定位方法的流程示意图;1 is a schematic flowchart of an indoor positioning method according to an embodiment of the present invention;
图2为本发明实施例的一种室内定位方法的流程示意图;2 is a schematic flowchart of an indoor positioning method according to an embodiment of the present invention;
图3为本发明实施例的一种室内定位装置的结构示意图。FIG. 3 is a schematic structural diagram of an indoor positioning device according to an embodiment of the present invention.
具体实施方式Detailed ways
下面结合附图和实施例,对本发明的具体实施方式作进一步详细描述。以下实施例用于说明本发明,但不用来限制本发明的范围。The specific embodiments of the present invention will be described in further detail below with reference to the accompanying drawings and embodiments. The following examples are intended to illustrate the present invention, but not to limit the scope of the present invention.
现有的室内定位方法主要是预先安装多个外部设备,如AP(Acess Piont,接入点),根据移动终端与外部设备之间信号强度与距离的映射关系,来对行人进行定位。由于需要安装多个外部设备,设备成本耗费较高。另外,多个外部设备之间通常需要设计复杂度较高的系统来协同工作。因此,室内定位时耗费的成本较高。The existing indoor positioning method mainly pre-installs multiple external devices, such as AP (Access Piont, access point), and locates pedestrians according to the mapping relationship between the signal strength and the distance between the mobile terminal and the external device. Since multiple external devices need to be installed, the equipment cost is high. In addition, a system with high design complexity is usually required to work together among multiple external devices. Therefore, the cost of indoor positioning is relatively high.
针对现有技术中的问题,本实施例提供了一种室内定位方法。该方法应用于移动终端,移动终端包括但不限于手机、平板电脑及智能手表等。另外,由于本发明实施例需要应用到传感器采集到的数据,从而移动终端中可安装有加速度传感器、陀螺仪及气压计等,本实施例对此也不作具体限定。In view of the problems in the prior art, this embodiment provides an indoor positioning method. The method is applied to a mobile terminal, and the mobile terminal includes but is not limited to a mobile phone, a tablet computer, a smart watch, and the like. In addition, since the embodiment of the present invention needs to be applied to the data collected by the sensor, an acceleration sensor, a gyroscope, a barometer, etc. may be installed in the mobile terminal, which is not specifically limited in this embodiment.
参见图1,本实施例提供的方法流程包括:101、根据多重传感器采集到的数据,预测行人的位置信息;102、基于室内运动模型,获取行人的室内运动状态;103、基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。Referring to FIG. 1 , the method process provided in this embodiment includes: 101. Predicting the location information of pedestrians according to data collected by multiple sensors; 102. Obtaining the indoor motion state of pedestrians based on an indoor motion model; 103. Based on an indoor environment map model , and calibrate the predicted pedestrian position information according to the indoor motion state and the position information of the indoor preset nodes to obtain the final position information of the pedestrian.
本发明实施例提供的方法,通过根据多重传感器采集到的数据,预测行人的位置信息。基于室内运动模型,获取行人的室内运动状态。基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。由于不用安装外部设备,从而在避免设计复杂度较高的系统的同时,还可减少硬件成本消耗,进而使得室内定位时耗费的成本较低。The method provided by the embodiment of the present invention predicts the location information of pedestrians according to the data collected by multiple sensors. Based on the indoor motion model, the indoor motion state of the pedestrian is obtained. Based on the indoor environment map model, the predicted pedestrian position information is calibrated according to the indoor motion state and the position information of the indoor preset nodes, and the final position information of the pedestrian is obtained. Since there is no need to install external equipment, while avoiding designing a system with high complexity, the hardware cost consumption can also be reduced, so that the cost of indoor positioning is lower.
另外,由于进行运动特征分类时,选取了加速度计、气压计和陀螺仪数据,提高了运动特征分类时的准确性,同时能够避免长时间累积误差的出现。由于定位过程将行人航位推测算法、室内行人运动特征以及隐马尔科夫模型匹配方法结合在了一起,从而在保证较高定位准确率的同时,还可以提升室内定位的鲁棒性。In addition, the accelerometer, barometer and gyroscope data are selected during the classification of motion features, which improves the accuracy of classification of motion features and avoids the occurrence of long-term accumulated errors. Since the positioning process combines the pedestrian dead reckoning algorithm, the indoor pedestrian motion feature and the hidden Markov model matching method, the robustness of indoor positioning can be improved while ensuring a high positioning accuracy.
作为一种可选实施例,根据多重传感器采集到的数据,预测行人的位置信息,包括:As an optional embodiment, the location information of pedestrians is predicted according to data collected by multiple sensors, including:
确定行人从开始移动到停止移动之间的总步数;Determining the total number of steps a pedestrian takes between starting to move and stopping;
对于行人移动的每一步,根据行人的步长、转向角及行人移动前的位置信息,计算行人移动一步后的位置信息,直到计算次数达到总步数,将最终计算结果作为行人的位置信息。For each step of the pedestrian's movement, according to the pedestrian's step length, steering angle and the position information before the pedestrian's movement, calculate the position information after the pedestrian moves one step, until the number of calculations reaches the total number of steps, and the final calculation result is used as the pedestrian's position information.
作为一种可选实施例,确定行人从开始移动到停止移动之间的总步数之前,还包括:As an optional embodiment, before determining the total number of steps of the pedestrian from starting to moving to stopping, the method further includes:
根据每个采样点的加速度,对行人开始移动及停止移动进行检测。According to the acceleration of each sampling point, the pedestrian starts to move and stops to move.
作为一种可选实施例,根据每个采样点的加速度,对行人开始移动进行检测,包括:As an optional embodiment, according to the acceleration of each sampling point, the detection of the pedestrian starting to move includes:
对于任一采样点,当检测到任一采样点的加速度不小于第一预设阈值时,确定在任一采样点上行人开始移动。For any sampling point, when it is detected that the acceleration of any sampling point is not less than the first preset threshold, it is determined that the pedestrian starts to move at any sampling point.
作为一种可选实施例,根据每个采样点的加速度,对行人停止移动进行检测,包括:As an optional embodiment, according to the acceleration of each sampling point, the pedestrian stops moving to be detected, including:
对于任一采样点,当检测到任一采样点的加速度小于第一预设阈值时,对自任一采样点起,连续小于第一预设阈值的采样点数量进行统计;For any sampling point, when it is detected that the acceleration of any sampling point is smaller than the first preset threshold, count the number of sampling points that are continuously smaller than the first preset threshold since any sampling point;
当统计结果达到预设数量时,获取统计结果达到预设数量时的最后一个采样点,确定行人在最后一个采样点上停止移动。When the statistical result reaches the preset number, the last sampling point when the statistical result reaches the preset number is obtained, and it is determined that the pedestrian stops moving at the last sampling point.
作为一种可选实施例,确定行人从开始移动到停止移动之间的总步数,包括:As an optional embodiment, determining the total number of steps the pedestrian takes from starting to moving to stopping, including:
对于行人从开始移动到停止移动这段时间内的任一采样点,当检测到任一采样点的加速度大于第二预设阈值,且任一采样点的下一采样点对应的加速度小于第二预设阈值时,将任一采样点的上一采样点、任一采样点及任一采样点的下一采样点作为一个步伐周期,并将行人的总步数加一。For any sampling point during the period from the start of the pedestrian to the stop of movement, when the acceleration of any sampling point is detected to be greater than the second preset threshold, and the acceleration corresponding to the next sampling point of any sampling point is less than the second When the threshold is preset, the previous sampling point of any sampling point, any sampling point and the next sampling point of any sampling point are regarded as one step cycle, and the total number of steps of pedestrians is increased by one.
作为一种可选实施例,将任一采样点的上一采样点、任一采样点及任一采样点的下一采样点作为一个步伐周期,并将行人的总步数加一之前,还包括:As an optional embodiment, the previous sampling point of any sampling point, any sampling point and the next sampling point of any sampling point are regarded as a step cycle, and before adding one to the total number of steps of pedestrians, also include:
根据上一步伐周期内的加速度相关值,计算第二预设阈值。The second preset threshold is calculated according to the acceleration-related value in the previous step cycle.
作为一种可选实施例,根据行人的步长、转向角及行人移动前的位置信息,计算行人移动一步后的位置信息之前,还包括:As an optional embodiment, before calculating the position information after the pedestrian moves by one step according to the pedestrian's step length, the steering angle and the position information before the pedestrian moves, the method further includes:
基于空间坐标系,获取当前行人在三个方向上的角加速度;Based on the space coordinate system, obtain the angular acceleration of the current pedestrian in three directions;
基于空间坐标系与地面坐标系之间的投影关系,根据当前行人在三个方向上的角加速度及加速度,计算行人的转向角。Based on the projection relationship between the space coordinate system and the ground coordinate system, the steering angle of the pedestrian is calculated according to the current angular acceleration and acceleration of the pedestrian in three directions.
作为一种可选实施例,根据多重传感器采集到的数据,预测行人的位置信息,包括:As an optional embodiment, the location information of pedestrians is predicted according to data collected by multiple sensors, including:
根据行人所处位置的空气压力值,确定行人所处的楼层。Determine the floor where the pedestrian is located according to the air pressure value at the location of the pedestrian.
作为一种可选实施例,基于室内运动模型,获取行人的室内运动状态,包括:As an optional embodiment, based on the indoor motion model, the indoor motion state of the pedestrian is obtained, including:
根据第一时间窗口内每个采样点的加速度,计算第一时间窗口对应的特征值;Calculate the eigenvalue corresponding to the first time window according to the acceleration of each sampling point in the first time window;
基于运动状态分类器,根据第一时间窗口对应的特征值,确定行人的运动特征。Based on the motion state classifier, the motion feature of the pedestrian is determined according to the feature value corresponding to the first time window.
作为一种可选实施例,基于室内运动模型,获取行人的室内运动状态,包括:As an optional embodiment, based on the indoor motion model, the indoor motion state of the pedestrian is obtained, including:
根据第二时间窗口内行人的转向角,计算行人的转弯角度;Calculate the turning angle of the pedestrian according to the turning angle of the pedestrian in the second time window;
根据行人的转弯角度,确定行人的转弯特征。According to the turning angle of the pedestrian, the turning characteristic of the pedestrian is determined.
作为一种可选实施例,基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息,包括:As an optional embodiment, based on the indoor environment map model, according to the indoor motion state and the position information of the indoor preset nodes, the predicted pedestrian position information is calibrated, and the final position information of the pedestrian is obtained, including:
基于室内环境地图模型,确定行人移动至室内环境地图模型中相邻预设节点的移动概率;Based on the indoor environment map model, determine the movement probability of pedestrians moving to adjacent preset nodes in the indoor environment map model;
将每个相邻预设节点的移动概率进行排序,选取排序结果中数值最大的两个移动概率,分别为第一移动概率与第二移动概率,第一移动概率大于第二移动概率;Sort the movement probabilities of each adjacent preset node, and select the two movement probabilities with the largest numerical values in the sorting result, which are respectively the first movement probability and the second movement probability, and the first movement probability is greater than the second movement probability;
当第一移动概率与第二移动概率的比值大于第三预设阈值时,将第一移动概率对应的相邻预设节点的位置信息作为行人的最终位置信息。When the ratio of the first movement probability to the second movement probability is greater than the third preset threshold, the position information of the adjacent preset nodes corresponding to the first movement probability is used as the final position information of the pedestrian.
作为一种可选实施例,基于室内环境地图模型,确定行人移动至室内环境地图模型中相邻预设节点的移动概率,包括:As an optional embodiment, based on the indoor environment map model, determining the movement probability of pedestrians moving to adjacent preset nodes in the indoor environment map model includes:
对于室内环境地图模型中任一相邻预设节点,根据任一相邻预设节点的位置信息,计算行人移动至任一相邻预设节点的发射概率;For any adjacent preset node in the indoor environment map model, according to the position information of any adjacent preset node, calculate the emission probability of pedestrian moving to any adjacent preset node;
根据运动识别概率矩阵,确定任一相邻预设节点的运动状态表现为室内运动状态的状态识别概率;According to the motion recognition probability matrix, determine the state recognition probability that the motion state of any adjacent preset node represents the indoor motion state;
将发射概率与状态识别概率之间的乘积作为行人移动至任一相邻预设节点的移动概率。The product between the emission probability and the state recognition probability is taken as the movement probability of the pedestrian moving to any adjacent preset node.
作为一种可选实施例,将每个相邻预设节点的移动概率进行排序,选取排序结果中数值最大的两个移动概率,分别为第一移动概率与第二移动概率之后,还包括:As an optional embodiment, the movement probabilities of each adjacent preset node are sorted, and the two movement probabilities with the largest numerical values in the sorting result are selected, which are respectively the first movement probability and the second movement probability, and further include:
当第一移动概率与第二移动概率的比值不大于第三预设阈值时,将预测得到的行人位置信息作为行人的最终位置信息。When the ratio of the first movement probability to the second movement probability is not greater than the third preset threshold, the predicted pedestrian position information is used as the pedestrian's final position information.
上述所有可选技术方案,可以采用任意结合形成本发明的可选实施例,在此不再一一赘述。All the above-mentioned optional technical solutions can be combined arbitrarily to form optional embodiments of the present invention, which will not be repeated here.
基于上述图1对应实施例所提供的内容,本发明实施例提供了一种室内定位方法。参见图2,本实施例提供的方法流程包括:201、确定行人从开始移动到停止移动之间的总步数;202、对于行人移动的每一步,根据行人的步长、转向角及行人移动前的位置信息,计算行人移动一步后的位置信息,直到计算次数达到总步数,将最终计算结果作为行人的位置信息;203、基于室内运动模型,获取行人的室内运动状态;204、基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。Based on the content provided by the above-mentioned embodiment corresponding to FIG. 1 , an embodiment of the present invention provides an indoor positioning method. Referring to FIG. 2 , the method process provided by this embodiment includes: 201. Determine the total number of steps between the pedestrian starts to move and stops moving; 202. For each step of the pedestrian's movement, according to the pedestrian's step length, the steering angle and the pedestrian's movement 203. Based on the indoor motion model, obtain the indoor motion state of the pedestrian; 204. Based on the indoor motion The environment map model calibrates the predicted pedestrian position information according to the indoor motion state and the position information of the indoor preset nodes, and obtains the final position information of the pedestrian.
其中,201、确定行人从开始移动到停止移动之间的总步数。Wherein, 201, determine the total number of steps between the pedestrian starts moving and stops moving.
本实施例提供的方法主要是先根据多重传感器采集到的数据,预测行人的位置信息,再对预测得到的行人位置信息进行校准以实现定位的过程。其中,本步骤201至步骤202主要是根据多重传感器采集到的数据,预测行人位置信息的过程。The method provided in this embodiment is mainly a process of first predicting the location information of pedestrians according to data collected by multiple sensors, and then calibrating the predicted location information of pedestrians to realize positioning. Among them, the steps 201 to 202 are mainly the process of predicting the pedestrian position information according to the data collected by the multiple sensors.
由于行人在室内什么时候开始移动及什么时候停止移动是未知的,从而在执行本步骤201之前,还可以根据每个采样点的加速度对行人开始移动及停止移动进行检测,本实施例对此不作具体限定。Since it is unknown when the pedestrian starts to move indoors and when it stops moving, before step 201 is executed, the pedestrian can also be detected based on the acceleration of each sampling point, which is not performed in this embodiment. Specific restrictions.
关于根据每个采样点的加速度,对行人开始移动进行检测的方式,本实施例对此不作具体限定,包括但不限于:对于任一采样点,当检测到任一采样点的加速度不小于第一预设阈值时,确定在任一采样点上行人开始移动。This embodiment does not specifically limit the method of detecting the pedestrian's start to move according to the acceleration of each sampling point, including but not limited to: for any sampling point, when the detected acceleration of any sampling point is not less than the first When a preset threshold is set, it is determined that pedestrians start to move at any sampling point.
其中,采样点对应的是传感器的采样周期。第一预设阈值可根据实际情况取值,本实施例对此不作具体限定。例如,以第一预设阈值为1.5m/s2为例。若加速度传感器的采样周期是20ms,则每隔20ms就是一个采样点。即加速度传感器在每个采样点上采集加速度值时,移动终端还会判断每个采样点上采集到的加速度值是否大于或等于1.5m/s2。若检测到一个采样点的加速度大于1.5m/s2,则确定行人从该采样点起开始移动。Among them, the sampling point corresponds to the sampling period of the sensor. The first preset threshold may be set according to the actual situation, which is not specifically limited in this embodiment. For example, take the first preset threshold as 1.5m/s 2 as an example. If the sampling period of the acceleration sensor is 20ms, every 20ms is a sampling point. That is, when the acceleration sensor collects the acceleration value at each sampling point, the mobile terminal also determines whether the acceleration value collected at each sampling point is greater than or equal to 1.5m/s 2 . If it is detected that the acceleration of a sampling point is greater than 1.5m/s 2 , it is determined that the pedestrian starts to move from the sampling point.
本实施例不对根据每个采样点的加速度,对行人停止移动进行检测的方式作具体限定,包括但不限于:对于任一采样点,当检测到任一采样点的加速度小于第一预设阈值时,对自任一采样点起,连续小于第一预设阈值的采样点数量进行统计;当统计结果达到预设数量时,获取统计结果达到预设数量时的最后一个采样点,确定行人在最后一个采样点上停止移动。其中,预设数量也可根据实际情况进行设置,本实施例对此不作具体限定。This embodiment does not specifically limit the way of detecting pedestrian stop moving according to the acceleration of each sampling point, including but not limited to: for any sampling point, when the detected acceleration of any sampling point is less than the first preset threshold , the number of sampling points that are continuously smaller than the first preset threshold from any sampling point is counted; when the statistical result reaches the preset number, the last sampling point when the statistical result reaches the preset number is obtained, and it is determined that the pedestrian is at the last Stop moving at a sample point. The preset number may also be set according to the actual situation, which is not specifically limited in this embodiment.
例如,以第一预设阈值为1.5m/s2,预设数量为30个为例。若检测到第10个采样点的加速度小于1.5m/s2,则继续检测第11个、第12个、……、第40个采样点的加速度。当第10个采样点后连续30个采样点的加速度都小于1.5m/s2时,即当第11个、第12个、……、第40个采样点的加速度小于1.5m/s2时,获取累计达到30个采样点时的最后一个采样点,即第40个采样点。相应地,在第40个采样点上,行人停止移动。For example, the first preset threshold is 1.5 m/s 2 and the preset number is 30 as an example. If it is detected that the acceleration of the 10th sampling point is less than 1.5 m/s 2 , continue to detect the acceleration of the 11th, 12th, . . . , 40th sampling points. When the acceleration of 30 consecutive sampling points after the 10th sampling point is less than 1.5m/s 2 , that is, when the acceleration of the 11th, 12th, ..., 40th sampling point is less than 1.5m/s 2 , and obtain the last sampling point when the accumulative number reaches 30 sampling points, that is, the 40th sampling point. Correspondingly, at the 40th sampling point, the pedestrian stops moving.
在确定行人开始移动及停止移动后,可确定行人从开始移动到停止移动这段时间内行走的总步数。本实施例不对确定行人从开始移动到停止移动之间的总步数的方式作具体限定,包括但不限于:对于行人从开始移动到停止移动这段时间内的任一采样点,当检测到任一采样点的加速度大于第二预设阈值,且任一采样点的下一采样点对应的加速度小于第二预设阈值时,将任一采样点的上一采样点、任一采样点及任一采样点的下一采样点作为一个步伐周期,并将行人的总步数加一。After it is determined that the pedestrian starts to move and stops to move, the total number of steps the pedestrian walks during the period from the start of the move to the stop of the move can be determined. This embodiment does not specifically limit the manner of determining the total number of steps of a pedestrian from starting to moving, including but not limited to: for any sampling point during the period from the start of the pedestrian to the stop of moving, when the pedestrian is detected When the acceleration of any sampling point is greater than the second preset threshold, and the acceleration corresponding to the next sampling point of any sampling point is less than the second preset threshold, the previous sampling point, any sampling point and The next sampling point of any sampling point is used as a step cycle, and the total number of steps of the pedestrian is increased by one.
由于人在行走时,一条腿在抬出时的加速度是较大的,而抬出后准备落地时加速度是较小的,从而基于上述原理,在上述过程中可对连续的两个采样点进行检测。将两个采样点与第二预设阈值进行比较,当前一个采样点大于第二预设阈值且后一个采样点小于第二预设阈值时,可视为行人走了一步。相应地,对于加速度大于第二预设阈值的采样点,当该采样点的下一采样点对应的加速度小于第二预设阈值时,可将上一采样点到下一采样点之间的这段时间作为一个步伐周期。例如,若第3个采样点的加速度大于第二预设阈值且第4个采样点的加速度小于第二预设阈值,则可将第2个采样点、第3个采样点及第4个采样点作为一个步伐周期,并视为行人在这个步伐周期内走了一步。相应地,总步数可加一。需要说明的是,在统计总步数之前总步数的初始值为0。When a person is walking, the acceleration of one leg is larger when it is lifted out, and the acceleration is smaller when it is ready to land after being lifted out. Therefore, based on the above principle, two consecutive sampling points can be measured in the above process. detection. Comparing the two sampling points with the second preset threshold, when the former sampling point is greater than the second preset threshold and the latter sampling point is less than the second preset threshold, it can be considered that the pedestrian has taken a step. Correspondingly, for a sampling point whose acceleration is greater than the second preset threshold, when the acceleration corresponding to the next sampling point of the sampling point is smaller than the second preset threshold, the time between the last sampling point and the next sampling point can be calculated. A period of time as a pace cycle. For example, if the acceleration of the third sampling point is greater than the second preset threshold and the acceleration of the fourth sampling point is less than the second preset threshold, the second sampling point, the third sampling point and the fourth sampling point can be point as a pace cycle, and consider the pedestrian to take a step in this pace cycle. Accordingly, the total number of steps may be increased by one. It should be noted that the initial value of the total number of steps is 0 before the total number of steps is counted.
另外,在确定总步数之前,还可根据上一步伐周期内的加速度相关值,计算第二预设阈值,本实施例对此不作具体限定。根据对行人航位推算的实验结果,第二预设阈值可通过动态阈值方程来计算,该动态阈值方程(1)如下所示:In addition, before the total number of steps is determined, the second preset threshold may also be calculated according to the acceleration related value in the previous step cycle, which is not specifically limited in this embodiment. According to the experimental results of pedestrian dead reckoning, the second preset threshold can be calculated by the dynamic threshold equation, and the dynamic threshold equation (1) is as follows:
其中,α和β是预先设置好的参数,可分别取值为0.25和0.75,本实施例对此不作具体限定。γ为环境噪声方差,可取值为0.09,本实施例对此也不作具体限定。Told为上一步伐周期的第二预设阈值,A1和A2为加速度相关值。A1和A2可分别代表上一步伐周期内加速度的最大值和最小值,A1和A2还可以为加速度的均值或者方差,本实施例对此不作具体限定。Among them, α and β are preset parameters, which may be respectively 0.25 and 0.75, which are not specifically limited in this embodiment. γ is the variance of environmental noise, which can be 0.09, which is not specifically limited in this embodiment. T old is the second preset threshold value of the previous step cycle, and A 1 and A 2 are acceleration-related values. A 1 and A 2 may respectively represent the maximum value and the minimum value of the acceleration in the previous step cycle, and A 1 and A 2 may also be the mean value or variance of the acceleration, which is not specifically limited in this embodiment.
其中,202、对于行人移动的每一步,根据行人的步长、转向角及行人移动前的位置信息,计算行人移动一步后的位置信息,直到计算次数达到总步数,将最终计算结果作为行人的位置信息。Among them, 202. For each step of the pedestrian's movement, calculate the position information after the pedestrian moves one step according to the pedestrian's step length, steering angle and the position information before the pedestrian's movement, until the number of calculation times reaches the total number of steps, and use the final calculation result as the pedestrian. location information.
在执行本步骤之前,可先获取行人的步长、行人移动前的位置信息及行人的转向角。其中,行人的步长根据行人身高进行估计,本实施例对此不作具体限定。由于本实施例提供的方法是迭代计算过程,即行人上一次移动前的位置信息也可通过本实施例提供的方法来获取,从而在获取行人移动前的位置信息时,可获取上次执行本实施例提供的方法所对应的计算结果即可。需要说明的是,当第一次对行人进行室内定位时,初始位置可根据实际情况进行设置,本实施例对此不作具体限定。Before executing this step, the step length of the pedestrian, the position information of the pedestrian before moving, and the steering angle of the pedestrian may be obtained. The step length of the pedestrian is estimated according to the height of the pedestrian, which is not specifically limited in this embodiment. Since the method provided in this embodiment is an iterative calculation process, that is, the position information of the pedestrian before the last movement can also be obtained by the method provided in this embodiment, so that when obtaining the position information of the pedestrian before the movement, the position information of the pedestrian before the last movement can be obtained. The calculation results corresponding to the methods provided in the embodiments are sufficient. It should be noted that, when indoor positioning of the pedestrian is performed for the first time, the initial position may be set according to the actual situation, which is not specifically limited in this embodiment.
另外,由于行人在移动时有可能做的是曲线运动,从而为了更加精准地对行人位置进行预测,还可以获取行人的转向角。本实施例不对获取行人的转向角的方式作具体限定,包括但不限于:基于空间坐标系,获取当前行人在三个方向上的角加速度;基于空间坐标系与地面坐标系之间的投影关系,根据当前行人在三个方向上的角加速度及加速度,计算行人的转向角。In addition, since the pedestrian may move in a curved motion, in order to more accurately predict the pedestrian's position, the steering angle of the pedestrian can also be obtained. This embodiment does not specifically limit the way of obtaining the steering angle of the pedestrian, including but not limited to: obtaining the angular acceleration of the current pedestrian in three directions based on the space coordinate system; based on the projection relationship between the space coordinate system and the ground coordinate system , according to the current angular acceleration and acceleration of the pedestrian in three directions, the steering angle of the pedestrian is calculated.
其中,按照空间坐标系可分为XYZ轴三个方向上的角速度。三个方向上的角加速度可通过移动终端中的陀螺仪进行获取,本实施例对此不作具体限定。在计算行人的转向角之前,可通过积分的方式根据三个方向上的角加速度计算三个方向上的角位移,本实施例对此不作具体限定。积分过程可参考如下公式(2):Among them, according to the space coordinate system, it can be divided into angular velocity in three directions of XYZ axis. The angular accelerations in the three directions may be acquired through a gyroscope in the mobile terminal, which is not specifically limited in this embodiment. Before calculating the steering angle of the pedestrian, the angular displacements in the three directions may be calculated according to the angular accelerations in the three directions by means of integration, which is not specifically limited in this embodiment. The integration process can refer to the following formula (2):
其中,及分别为XYZ三个方向上的角加速度。tbegin为移动一步的起始时刻,tstop为移动一步的终止时刻。θx、θy及θz分别为XYZ三个方向上的角位移。in, and are the angular accelerations in the three directions, XYZ, respectively. t begin is the start time of one move, and t stop is the end time of one move. θ x , θ y and θ z are the angular displacements in the three directions of XYZ, respectively.
需要说明的是,若在一个时间窗口内XYZ三个方向上的角位移均比较小时,如小于角度阈值,则可视为行人在这个时间窗口内作的是直线运动。例如,以角度阈值为15°为例。当在一个时间窗口内XYZ三个方向上的角位移θx、θy及θz均小于15°时,则可确定行人在这个时间窗口内作的是直线运动。It should be noted that if the angular displacements in the three directions of XYZ in a time window are relatively small, such as less than the angle threshold, it can be considered that the pedestrian is moving in a straight line in this time window. For example, take an angle threshold of 15° as an example. When the angular displacements θ x , θ y and θ z in the three directions of XYZ in a time window are all less than 15°, it can be determined that the pedestrian moves in a straight line in this time window.
基于上述原理,行人在直线行走的过程中,可计算三个方向上的加速度算术平均值。相应地,可根据当前行人在三个方向上的角位移及加速度算术平均值,计算行人的转向角,本实施例对此不作具体限定。上述计算过程,可通过如下定义的行人航位推算模型(3)进行表示:Based on the above principles, the pedestrian can calculate the arithmetic mean of accelerations in three directions when walking in a straight line. Correspondingly, the steering angle of the pedestrian can be calculated according to the current arithmetic mean value of the angular displacement and acceleration of the pedestrian in three directions, which is not specifically limited in this embodiment. The above calculation process can be represented by the pedestrian dead reckoning model (3) defined as follows:
其中,Oz为行人的转向角。θx、θy及θz分别为三个方向上的角位移。及分别为三个方向上的加速度算术平均值。where O z is the steering angle of the pedestrian. θ x , θ y and θ z are angular displacements in three directions, respectively. and are the arithmetic mean of the accelerations in the three directions, respectively.
在计算得到行人的转向角后,对于行人移动的每一步,可根据行人的步长、转向角及行人移动前的位置信息,计算行人移动一步后的位置信息。该计算过程可参考如下公式(4):After the pedestrian's steering angle is calculated, for each step of the pedestrian's movement, the position information after the pedestrian moves one step can be calculated according to the pedestrian's step length, steering angle, and position information before the pedestrian moves. The calculation process can refer to the following formula (4):
其中,lk为行人的步长。基于地面坐标系,xk-1及yk-1为行人在移动一步前的位置信息,xk及yk为行人在移动一步后的位置信息。Among them, lk is the step size of the pedestrian. Based on the ground coordinate system, x k-1 and y k-1 are the position information of the pedestrian before moving one step, and x k and y k are the position information of the pedestrian after moving one step.
基于上述步骤201中确定的总步数,按照上述公式(4)可确定行人在走了这么多步后的位置信息,即预测得到的行人位置信息。Based on the total number of steps determined in the above step 201, the position information of the pedestrian after taking so many steps can be determined according to the above formula (4), that is, the predicted position information of the pedestrian.
需要说明的是,上述过程预测的主要是行人基于地面坐标系的位置信息。由于在对行人进行室内定位时,可能会需要对其所在建筑物的楼层进行定位,从而预测得到的行人位置信息还可以包括行人所在的楼层。本实施例还提供了一种确定行人所在楼层的方法,包括但不限于:根据行人所处位置的空气压力值,确定行人所处的楼层。It should be noted that the above-mentioned process mainly predicts the location information of pedestrians based on the ground coordinate system. Since the floor of the building where the pedestrian is located may need to be located when locating the pedestrian indoors, the predicted pedestrian location information may also include the floor where the pedestrian is located. This embodiment also provides a method for determining the floor where the pedestrian is located, including but not limited to: determining the floor where the pedestrian is located according to the air pressure value at the location where the pedestrian is located.
由于在地球大气层内空气压力成高度成反比,即当高度增加时空气压力会减少,从而可以利用气压计测量得到的空气压力,计算行人所在高度。按照行人所在建筑物的层高与行人所在的高度,可确定行人所在的楼层,本实施例对此不作具体限定。基于ICAO(International Civil Aviation Organization,国际民用航空组织)模型,可获知高度每增加约8.7米大气压力减少1mbar。根据1993年的标准大气压力,计算行人所在的高度可参考如下公式(5):Since the air pressure in the earth's atmosphere is inversely proportional to the height, that is, the air pressure decreases when the height increases, so the air pressure measured by the barometer can be used to calculate the height of the pedestrian. The floor where the pedestrian is located can be determined according to the floor height of the building where the pedestrian is located and the height where the pedestrian is located, which is not specifically limited in this embodiment. Based on the ICAO (International Civil Aviation Organization, International Civil Aviation Organization) model, it can be known that the atmospheric pressure decreases by 1 mbar for every increase of about 8.7 meters in altitude. According to the standard atmospheric pressure in 1993, the height of the pedestrian can be calculated by referring to the following formula (5):
其中,P0代表的是标准大气压力(1013.25mbar)。H为行人所在的高度,单位为米。Among them, P 0 represents the standard atmospheric pressure (1013.25mbar). H is the height of the pedestrian, in meters.
其中,203、基于室内运动模型,获取行人的室内运动状态。Among them, 203, based on the indoor motion model, obtain the indoor motion state of the pedestrian.
在执行本步骤之前,可先根据行人在室内的运动习惯确定行人在室内运动状态,本实施例对此不作具体限定。在本实施例中,根据实际生活场景将行人的运动状态划分成7个,分别为:行走、坐下、站立、上楼、下楼、转弯及U型转弯。Before executing this step, the indoor motion state of the pedestrian may be determined according to the indoor motion habit of the pedestrian, which is not specifically limited in this embodiment. In this embodiment, the motion states of pedestrians are divided into 7 according to actual life scenarios, namely: walking, sitting, standing, going upstairs, going downstairs, turning and U-turn.
其中,行走、坐下、站立、上楼及下楼均为行人移动过程中的运动特征。转弯及U型转弯为行人在移动过程中的转弯特征。由于行人在转弯时,可能是调整方向的小转弯也有可能是掉头的大转弯,从而为了区分这两种转弯,在上述转弯特征划分时划分为了转弯及U型转弯。在判定转弯与U型转弯时,可根据行人在时间窗口内的转弯角度与预设阈值范围之间的比较结果来判定。例如,当转弯角度在50°~135°时,可认为是个普通的转弯。当转弯角度大于135°时,可认为是个U形转弯。Among them, walking, sitting, standing, going upstairs and going downstairs are all motion characteristics of pedestrians in the process of moving. Turns and U-turns are the turning characteristics of pedestrians in the process of moving. Since pedestrians are turning, it may be a small turn to adjust the direction or a big turn to make a U-turn. Therefore, in order to distinguish these two kinds of turns, the above turning features are divided into turns and U-turns. When determining a turn and a U-turn, it can be determined according to the comparison result between the pedestrian's turning angle within the time window and the preset threshold range. For example, when the turning angle is between 50° and 135°, it can be regarded as an ordinary turn. When the turning angle is greater than 135°, it can be considered as a U-turn.
基于上述内容,本步骤在获取行人的室内状态时,可分别获取行人的运动特征及转弯特征。本实施例不对基于室内运动模型,获取行人的运动特征的方式作具体限定,包括但不限于:根据第一时间窗口内每个采样点的加速度,计算第一时间窗口对应的特征值;基于运动状态分类器,根据第一时间窗口对应的特征值,确定行人的运动特征。Based on the above content, when acquiring the indoor state of the pedestrian in this step, the motion feature and the turning feature of the pedestrian can be acquired respectively. This embodiment does not specifically limit the way of acquiring the motion features of pedestrians based on the indoor motion model, including but not limited to: calculating the feature value corresponding to the first time window according to the acceleration of each sampling point in the first time window; The state classifier determines the motion characteristics of the pedestrian according to the feature values corresponding to the first time window.
其中,运动状态分类器可通过KNN(k-Nearest-Neighbor,K最近邻)分类器进行训练,本实施例对此不作具体限定。具体可先选取预设数量的实验人员实践上述五种运动特征,即行走、坐下、站立、上楼及下楼,并获取实验人员在实践运动特征时的特征值。通过将一种运动特征及每个实验人员在每次实践该运动特征时的特征值输入至KNN模型中,对KNN模型进行不停地训练,直到训练次数达到预设次数为止。最终,根据训练结果可以得到运动状态分类器及运动识别概率矩阵。其中,运动状态分类器用于根据输入的特征值确定行人的运动特征。The motion state classifier may be trained by a KNN (k-Nearest-Neighbor, K nearest neighbor) classifier, which is not specifically limited in this embodiment. Specifically, a preset number of experimenters can be selected to practice the above five motion characteristics, namely walking, sitting, standing, upstairs and downstairs, and the characteristic values of the experimenters when they practice the motion characteristics can be obtained. By inputting a motion feature and the feature value of each experimenter each time the motion feature is practiced into the KNN model, the KNN model is continuously trained until the number of training times reaches a preset number of times. Finally, the motion state classifier and motion recognition probability matrix can be obtained according to the training results. Among them, the motion state classifier is used to determine the motion features of pedestrians according to the input feature values.
运动识别概率矩阵为行人的每种运动特征被识别对以及被识别为其它运动特征的概率矩阵。例如,以行人当前的运动特征实际上为“坐下”为例。基于运动状态分类器,根据输入的特征值可能识别出该行人的运动特征确实为“坐下”。此时,识别结果是正确的,这对应着一个概率。但是本来是“坐下”,还可能被识别为“行走”。此时,识别结果是错误的,这也对应着一个概率。基于上述理论,通过对KNN模型不停地训练,在得到运动状态分类器的同时,还可以得到运动识别概率矩阵。The motion recognition probability matrix is a probability matrix in which each motion feature of the pedestrian is recognized as well as other motion features. For example, take the pedestrian's current motion feature actually being "sit down" as an example. Based on the motion state classifier, it may be recognized that the pedestrian's motion feature is indeed "sit down" according to the input feature value. At this time, the recognition result is correct, which corresponds to a probability. However, it was originally "sit down" and may also be identified as "walking". At this time, the recognition result is wrong, which also corresponds to a probability. Based on the above theory, through continuous training of the KNN model, the motion recognition probability matrix can also be obtained while the motion state classifier is obtained.
相应地,在得到运动状态分类器后,只需获取行人在第一时间窗口对应的特征值,便可基于运动状态分类器,确定行人的运动特征。其中,特征值可根据第一时间窗口内每个采样点的加速度进行计算,本实施例对此不作具体限定。特征值可以包括第一时间窗口内三个方向上加速度的均值与方差、空气压力值及三个方向上加速度的幅度等,本实施例对此不作具体限定。第一时间窗口的长度可以取2s~3s,本实施例对此不作具体限定。考虑到行人行走时动作的连续性,第一时间窗口还可以设置为50%的重叠覆盖,本实施例对此也不作具体限定。例如,第一时间窗口可以取值为0s~2s、1s~3s、2s~4s……。Correspondingly, after the motion state classifier is obtained, only the feature value corresponding to the pedestrian in the first time window is obtained, and then the motion feature of the pedestrian can be determined based on the motion state classifier. The characteristic value may be calculated according to the acceleration of each sampling point in the first time window, which is not specifically limited in this embodiment. The characteristic value may include the mean value and variance of the acceleration in the three directions in the first time window, the air pressure value, and the magnitude of the acceleration in the three directions, etc., which are not specifically limited in this embodiment. The length of the first time window may be 2s to 3s, which is not specifically limited in this embodiment. Considering the continuity of actions when pedestrians walk, the first time window may also be set to overlap coverage of 50%, which is not specifically limited in this embodiment. For example, the first time window may be 0s˜2s, 1s˜3s, 2s˜4s . . .
除了确定行人的运动特征,该可以确定行人的转弯特征。本实施例不对确定行人的转弯特征的方式作具体限定,包括但不限于:根据第二时间窗口内行人的转向角,计算行人的转弯角度;根据行人的转弯角度,确定行人的转弯特征。In addition to determining the pedestrian's motion characteristics, this can determine the pedestrian's turning characteristics. This embodiment does not specifically limit the method of determining the turning feature of the pedestrian, including but not limited to: calculating the turning angle of the pedestrian according to the turning angle of the pedestrian in the second time window; determining the turning feature of the pedestrian according to the turning angle of the pedestrian.
其中,第二时间窗口的长度也可以取2s~3s,本实施例对此不作具体限定。另外,第一时间窗口与第二时间窗口的长度可以相同,也可以不同,本实施例对此也不作具体限定。具体在计算行人的转弯角度时,可先计算第二时间窗口起始时刻的第一转向角,再计算第二时间窗口终止时刻的第二转向角。将第一转向角与第二转向角之间的差值作为行人的转弯角度。其中,计算转向角的过程可参考上述公式(3)的过程,此处不再赘述。The length of the second time window may also be 2s to 3s, which is not specifically limited in this embodiment. In addition, the lengths of the first time window and the second time window may be the same or different, which are not specifically limited in this embodiment. Specifically, when calculating the turning angle of the pedestrian, the first steering angle at the beginning of the second time window may be calculated first, and then the second steering angle at the end of the second time window may be calculated. The difference between the first steering angle and the second steering angle is taken as the turning angle of the pedestrian. The process of calculating the steering angle may refer to the process of the above formula (3), which will not be repeated here.
例如,以第二时间窗口长度为2s,第二时间窗口为1s~3s为例。在计算行人的转弯角度时,可先计算1s时行人的转向角,再计算3s时行人的转向角,从而将两个转向角的差值作为行人的转弯角度。For example, the length of the second time window is 2s, and the second time window is 1s˜3s as an example. When calculating the turning angle of a pedestrian, the turning angle of the pedestrian at 1s can be calculated first, and then the turning angle of the pedestrian at 3s can be calculated, so that the difference between the two steering angles can be used as the turning angle of the pedestrian.
通过上述过程,最终可以得到行人的运动特征及转弯特征。其中,运动特征为行走、坐下、站立、上楼及下楼中的一种,转弯特征为转弯及U型转弯中的一种。结合运动特征及转弯特征,即可得到行人的室内运动状态。Through the above process, the motion characteristics and turning characteristics of pedestrians can be finally obtained. The motion feature is one of walking, sitting, standing, going upstairs and going downstairs, and the turning feature is one of turning and U-turn. Combined with motion features and turning features, the indoor motion state of pedestrians can be obtained.
其中,204、基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。Wherein, 204, based on the indoor environment map model, according to the indoor motion state and the position information of the indoor preset nodes, calibrate the predicted pedestrian position information to obtain the pedestrian's final position information.
由于上述步骤201至步骤202中预测得到的行人位置信息可能会存在一定的误差,从而在本步骤可以基于室内环境地图模型中预设节点的位置信息,对步骤201至步骤202中预测得到的行人位置信息进行校准。本实施例不对基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息的方式作具体限定,包括但不限于:基于室内环境地图模型,确定行人移动至室内环境地图模型中相邻预设节点的移动概率;将每个相邻预设节点的移动概率进行排序,选取排序结果中数值最大的两个移动概率,分别为第一移动概率与第二移动概率,第一移动概率大于第二移动概率;当第一移动概率与第二移动概率的比值大于第三预设阈值时,将第一移动概率对应的相邻预设节点的位置信息作为行人的最终位置信息。Since the pedestrian position information predicted in the above steps 201 to 202 may have certain errors, in this step, based on the position information of the preset nodes in the indoor environment map model, the pedestrian predicted in the steps 201 to 202 can be used. position information for calibration. This embodiment does not specifically limit the method of calibrating the predicted pedestrian position information based on the indoor environment map model, according to the indoor motion state and the position information of the indoor preset nodes, and obtaining the final position information of the pedestrian, including but not limited to: Based on the indoor environment map model, determine the movement probability of pedestrians moving to adjacent preset nodes in the indoor environment map model; sort the movement probability of each adjacent preset node, and select the two movement probabilities with the largest values in the ranking result, They are the first movement probability and the second movement probability, respectively, and the first movement probability is greater than the second movement probability; when the ratio of the first movement probability and the second movement probability is greater than the third preset threshold, the phase corresponding to the first movement probability is calculated. The position information of the adjacent preset nodes is used as the final position information of the pedestrian.
其中,室内环境地图模型为由实际生活场景构建得到。具体地,一栋建筑物里楼梯拐角点及过道拐角点等节点的位置通常是可预先确定的。依据每个节点的节点坐标、每个节点与其空间上可直达的相邻节点之间的方向及距离、行人在每个节点上的运动状态,可建立室内环境地图模型。Among them, the indoor environment map model is constructed from the actual life scene. Specifically, the locations of nodes such as stair corner points and aisle corner points in a building can usually be predetermined. According to the node coordinates of each node, the direction and distance between each node and its spatially accessible adjacent nodes, and the motion state of pedestrians on each node, an indoor environment map model can be established.
在基于室内环境地图模型,确定行人移动至室内环境地图模型中相邻预设节点的移动概率之前,可先获取行人移动前的位置信息。由上述步骤201至步骤204中的内容可知,由于本实施例提供的方法是迭代计算的,即根据上一次计算结果来继续推演行人下一次移动后的位置信息,从而本步骤在获取行人移动前的位置信息时,可获取上一次通过本实施例提供的方法计算得到的行人位置信息,本实施例对此不作具体限定。Before determining the movement probability of pedestrians moving to adjacent preset nodes in the indoor environment map model based on the indoor environment map model, the location information of the pedestrian before moving can be obtained first. It can be seen from the content in the above steps 201 to 204 that since the method provided in this embodiment is calculated iteratively, that is, the position information of the pedestrian after the next movement is continuously deduced according to the previous calculation result, so this step is obtained before the pedestrian moves. When the location information of the pedestrian is obtained, the location information of the pedestrian calculated by the method provided in this embodiment can be obtained last time, which is not specifically limited in this embodiment.
在确定行人移动前的位置信息后,依据室内环境地图模型中每个预设节点的位置信息,可以确定行人从移动前的位置能够直接达到室内环境地图模型中的哪些预设节点。这些预设节点即为行人移动前的位置所对应的相邻预设节点。基于上述内容,对于任一相邻预设节点,本实施例不对确定行人移动至室内环境地图模型中相邻预设节点的移动概率的方式作具体限定,包括但不限于:对于室内环境地图模型中任一相邻预设节点,根据任一相邻预设节点的位置信息,计算行人移动至任一相邻预设节点的发射概率;根据运动识别概率矩阵,确定任一相邻预设节点的运动状态表现为室内运动状态的状态识别概率;将发射概率与状态识别概率之间的乘积作为行人移动至任一相邻预设节点的移动概率。After determining the position information of the pedestrian before moving, according to the position information of each preset node in the indoor environment map model, it can be determined which preset nodes in the indoor environment map model the pedestrian can directly reach from the position before moving. These preset nodes are the adjacent preset nodes corresponding to the pedestrian's position before moving. Based on the above content, for any adjacent preset node, this embodiment does not specifically limit the way of determining the movement probability of pedestrians moving to adjacent preset nodes in the indoor environment map model, including but not limited to: for indoor environment map models For any adjacent preset node, according to the position information of any adjacent preset node, calculate the emission probability of pedestrian moving to any adjacent preset node; according to the motion recognition probability matrix, determine any adjacent preset node The motion state of , is expressed as the state recognition probability of the indoor motion state; the product between the emission probability and the state recognition probability is taken as the movement probability of pedestrians moving to any adjacent preset node.
其中,发射概率为由一个隐藏状态产生一个观测状态的概率,行人移动前的位置信息为一个隐藏状态,相邻预设节点的位置信息为观测状态。在计算发射概率时,可参考如下公式(6):Among them, the emission probability is the probability of generating an observation state from a hidden state, the position information of the pedestrian before moving is a hidden state, and the position information of the adjacent preset nodes is the observation state. When calculating the emission probability, the following formula (6) can be referred to:
在上述公式(6)中,P(zt|ri)为发射概率。zt为相邻预设节点的位置信息,ri为行人移动前的位置信息,zt-ri表示两者间的欧式距离。σ为行人移动距离计算值的标准差,本实施例中σ的值为0.1。In the above formula (6), P(z t |r i ) is the emission probability. z t is the position information of the adjacent preset nodes, ri is the position information before the pedestrian moves, and z t - ri is the Euclidean distance between the two. σ is the standard deviation of the calculated value of the pedestrian moving distance, and the value of σ in this embodiment is 0.1.
基于上述步骤203中运动识别概率矩阵的相关内容,对于任一相邻预设节点,在确定该相邻预设节点的运动状态表现为室内运动状态的状态识别概率时,可根据室内运动状态中的运动特征及该相邻预设节点的运动特征,在运动识别概率矩阵查找对应的概率。将查找到的概率作为状态识别概率。Based on the relevant content of the motion recognition probability matrix in the above step 203, for any adjacent preset node, when determining the state recognition probability that the motion state of the adjacent preset node is an indoor motion state, it can be determined according to the indoor motion state. The motion feature of , and the motion feature of the adjacent preset node are searched for the corresponding probability in the motion recognition probability matrix. Use the found probability as the state recognition probability.
另外,在根据发射概率及状态识别概率计算行人移动至任一相邻预设节点的移动概率时,计算过程可参考如下公式(7):In addition, when calculating the movement probability of pedestrians moving to any adjacent preset node according to the emission probability and the state recognition probability, the calculation process can refer to the following formula (7):
P(zt,mt|ri)=P(zt|ri)P(mt|ri) (7)P(z t ,m t |r i )=P(z t |r i )P(m t |r i ) (7)
其中,P(zt|ri)为发射概率,P(mt|ri)为状态识别概率,P(zt,mt|ri)为移动概率。Among them, P(z t |r i ) is the emission probability, P(m t |r i ) is the state recognition probability, and P(z t ,m t |r i ) is the movement probability.
由于在室内环境地图模型中与行人移动前位置相邻的预设节点可能会有多个,从而可按照上述计算过程,计算每个相邻预设节点的移动概率。在计算得到多个移动概率后,可对所有的移动概率进行排序,从排序结果中选取数值最大的两个移动概率,计为第一移动概率与第二移动概率。其中,第一移动概率大于第二移动概率,即第一移动概率为移动概率中的最大值,第二移动概率为移动概率中的次大值。Since there may be multiple preset nodes adjacent to the pedestrian's position before moving in the indoor environment map model, the movement probability of each adjacent preset node can be calculated according to the above calculation process. After a plurality of movement probabilities are obtained by calculation, all movement probabilities may be sorted, and two movement probabilities with the largest numerical values are selected from the sorting results, and are counted as the first movement probability and the second movement probability. The first movement probability is greater than the second movement probability, that is, the first movement probability is the maximum value of the movement probabilities, and the second movement probability is the second largest value of the movement probabilities.
为了更精准地确定行人的位置信息,可计算第一移动概率与第二移动概率的比值。当比值大于第三预设阈值时,说明行人移动至第一移动概率对应的相邻预设节点的可能性,要远大于移动至第二移动概率对应的相邻预设节点的可能性。因此,可认为行人移动至第一移动概率对应的相邻预设节点时,可信度较高。此时,可将第一移动概率对应的相邻预设节点的位置信息作为行人的最终位置信息,并摒弃上述步骤201至202中预测得到的位置信息。In order to more accurately determine the position information of the pedestrian, the ratio of the first movement probability to the second movement probability may be calculated. When the ratio is greater than the third preset threshold, it indicates that the possibility of the pedestrian moving to the adjacent preset node corresponding to the first movement probability is much greater than the possibility of moving to the adjacent preset node corresponding to the second movement probability. Therefore, it can be considered that when the pedestrian moves to the adjacent preset node corresponding to the first movement probability, the reliability is high. At this time, the position information of the adjacent preset nodes corresponding to the first movement probability may be used as the final position information of the pedestrian, and the position information predicted in the above steps 201 to 202 is discarded.
另外,当第一移动概率与第二移动概率的比值不大于第三预设阈值时,可将上述步骤201至202中预测得到的行人位置信息作为行人的最终位置信息。In addition, when the ratio of the first movement probability to the second movement probability is not greater than the third preset threshold, the pedestrian position information predicted in the above steps 201 to 202 may be used as the pedestrian's final position information.
本发明实施例提供的方法,通过确定行人从开始移动到停止移动之间的总步数。对于行人移动的每一步,根据行人的步长、转向角及行人移动前的位置信息,计算行人移动一步后的位置信息,直到计算次数达到总步数,将最终计算结果作为行人的位置信息。基于室内运动模型,获取行人的室内运动状态。基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。由于不用安装外部设备,从而在避免设计复杂度较高的系统的同时,还可减少硬件成本消耗,进而使得室内定位时耗费的成本较低。In the method provided by the embodiment of the present invention, the total number of steps between the pedestrian starting to move and the stop moving is determined. For each step of the pedestrian's movement, according to the pedestrian's step length, steering angle and the position information before the pedestrian's movement, calculate the position information after the pedestrian moves one step, until the number of calculations reaches the total number of steps, and the final calculation result is used as the pedestrian's position information. Based on the indoor motion model, the indoor motion state of the pedestrian is obtained. Based on the indoor environment map model, the predicted pedestrian position information is calibrated according to the indoor motion state and the position information of the indoor preset nodes, and the final position information of the pedestrian is obtained. Since there is no need to install external equipment, while avoiding designing a system with high complexity, the hardware cost consumption can also be reduced, so that the cost of indoor positioning is lower.
另外,由于进行运动特征分类时,选取了加速度计、气压计和陀螺仪数据,提高了运动特征分类时的准确性,同时能够避免长时间累积误差的出现。由于定位过程将行人航位推测算法、室内行人运动特征以及隐马尔科夫模型匹配方法结合在了一起,从而在保证较高定位准确率的同时,还可以提升室内定位的鲁棒性。In addition, the accelerometer, barometer and gyroscope data are selected during the classification of motion features, which improves the accuracy of classification of motion features and avoids the occurrence of long-term accumulated errors. Since the positioning process combines the pedestrian dead reckoning algorithm, the indoor pedestrian motion feature and the hidden Markov model matching method, the robustness of indoor positioning can be improved while ensuring a high positioning accuracy.
本发明实施例提供了一种室内定位装置,该装置用于执行上述图1或图2对应的实施例中所提供的室内定位方法。参见图3,该装置包括:An embodiment of the present invention provides an indoor positioning apparatus, and the apparatus is configured to execute the indoor positioning method provided in the embodiment corresponding to FIG. 1 or FIG. 2 above. Referring to Figure 3, the device includes:
预测模块301,用于根据多重传感器采集到的数据,预测行人的位置信息;The prediction module 301 is used for predicting the position information of pedestrians according to the data collected by multiple sensors;
获取模块302,用于基于室内运动模型,获取行人的室内运动状态;an acquisition module 302, configured to acquire the indoor motion state of the pedestrian based on the indoor motion model;
校准模块303,用于基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。The calibration module 303 is configured to calibrate the predicted pedestrian position information based on the indoor environment map model, according to the indoor motion state and the position information of the indoor preset nodes, to obtain the final position information of the pedestrian.
作为一种可选实施例,预测模块301,包括:As an optional embodiment, the prediction module 301 includes:
确定单元,用于确定行人从开始移动到停止移动之间的总步数;A determination unit for determining the total number of steps the pedestrian takes between starting to move and stopping;
第一计算单元,用于对于行人移动的每一步,根据行人的步长、转向角及行人移动前的位置信息,计算行人移动一步后的位置信息,直到计算次数达到总步数,将最终计算结果作为行人的位置信息。The first calculation unit is used to calculate the position information after the pedestrian moves one step according to the step length, the steering angle and the position information before the pedestrian moves for each step of the pedestrian's movement, until the number of calculation times reaches the total number of steps, and the final calculation is performed. The result is used as the location information of the pedestrian.
作为一种可选实施例,预测模块301,还包括:As an optional embodiment, the prediction module 301 further includes:
检测单元,用于根据每个采样点的加速度,对行人开始移动及停止移动进行检测。The detection unit is used to detect the pedestrian's start and stop movement according to the acceleration of each sampling point.
作为一种可选实施例,检测单元,用于对于任一采样点,当检测到任一采样点的加速度不小于第一预设阈值时,确定在任一采样点上行人开始移动。As an optional embodiment, the detection unit is configured to, for any sampling point, determine that the pedestrian starts to move at any sampling point when it is detected that the acceleration of any sampling point is not less than the first preset threshold.
作为一种可选实施例,检测单元,用于对于任一采样点,当检测到任一采样点的加速度小于第一预设阈值时,对自任一采样点起,连续小于第一预设阈值的采样点数量进行统计;当统计结果达到预设数量时,获取统计结果达到预设数量时的最后一个采样点,确定行人在最后一个采样点上停止移动。As an optional embodiment, the detection unit is configured to, for any sampling point, detect that the acceleration of any sampling point is smaller than the first preset threshold value, to detect that the acceleration of any sampling point is less than the first preset threshold value continuously since any sampling point The number of sampling points is counted; when the statistical result reaches the preset number, the last sampling point when the statistical result reaches the preset number is obtained, and it is determined that the pedestrian stops moving at the last sampling point.
作为一种可选实施例,确定单元,用于对于行人从开始移动到停止移动这段时间内的任一采样点,当检测到任一采样点的加速度大于第二预设阈值,且任一采样点的下一采样点对应的加速度小于第二预设阈值时,将任一采样点的上一采样点、任一采样点及任一采样点的下一采样点作为一个步伐周期,并将行人的总步数加一。As an optional embodiment, the determining unit is configured to, for any sampling point during the period from the start of the pedestrian to the stop of the pedestrian movement, when the acceleration of any sampling point is detected to be greater than the second preset threshold, and any When the acceleration corresponding to the next sampling point of the sampling point is less than the second preset threshold, the previous sampling point of any sampling point, any sampling point and the next sampling point of any sampling point are regarded as a step cycle, and the Add one to the pedestrian's total steps.
作为一种可选实施例,预测模块301,还包括:As an optional embodiment, the prediction module 301 further includes:
第二计算单元,用于根据上一步伐周期内的加速度相关值,计算第二预设阈值。The second calculation unit is configured to calculate the second preset threshold value according to the acceleration related value in the previous step cycle.
作为一种可选实施例,预测模块301,还包括:As an optional embodiment, the prediction module 301 further includes:
获取单元,用于基于空间坐标系,获取当前行人在三个方向上的角加速度;The acquisition unit is used to acquire the angular acceleration of the current pedestrian in three directions based on the space coordinate system;
第三计算单元,用于基于空间坐标系与地面坐标系之间的投影关系,根据当前行人在三个方向上的角加速度及加速度,计算行人的转向角。The third calculation unit is configured to calculate the steering angle of the pedestrian according to the current angular acceleration and acceleration of the pedestrian in three directions based on the projection relationship between the space coordinate system and the ground coordinate system.
作为一种可选实施例,预测模块301,用于根据行人所处位置的空气压力值,确定行人所处的楼层。As an optional embodiment, the prediction module 301 is configured to determine the floor where the pedestrian is located according to the air pressure value at the location where the pedestrian is located.
作为一种可选实施例,获取模块302,用于根据第一时间窗口内每个采样点的加速度,计算第一时间窗口对应的特征值;基于运动状态分类器,根据第一时间窗口对应的特征值,确定行人的运动特征。As an optional embodiment, the obtaining module 302 is configured to calculate the characteristic value corresponding to the first time window according to the acceleration of each sampling point in the first time window; based on the motion state classifier, according to the acceleration corresponding to the first time window The eigenvalues determine the motion characteristics of pedestrians.
作为一种可选实施例,获取模块302,用于根据第二时间窗口内行人的转向角,计算行人的转弯角度;根据行人的转弯角度,确定行人的转弯特征。As an optional embodiment, the obtaining module 302 is configured to calculate the turning angle of the pedestrian according to the turning angle of the pedestrian in the second time window; and determine the turning characteristic of the pedestrian according to the turning angle of the pedestrian.
作为一种可选实施例,校准模块303,包括:As an optional embodiment, the calibration module 303 includes:
确定单元,用于基于室内环境地图模型,确定行人移动至室内环境地图模型中相邻预设节点的移动概率;a determining unit, configured to determine the movement probability of pedestrians moving to adjacent preset nodes in the indoor environment map model based on the indoor environment map model;
选取单元,用于将每个相邻预设节点的移动概率进行排序,选取排序结果中数值最大的两个移动概率,分别为第一移动概率与第二移动概率,第一移动概率大于第二移动概率;The selection unit is used to sort the movement probabilities of each adjacent preset node, and selects the two movement probabilities with the largest values in the sorting result, which are respectively the first movement probability and the second movement probability, and the first movement probability is greater than the second movement probability. move probability;
第一比较单元,用于当第一移动概率与第二移动概率的比值大于第三预设阈值时,将第一移动概率对应的相邻预设节点的位置信息作为行人的最终位置信息。The first comparison unit is configured to use the position information of the adjacent preset nodes corresponding to the first movement probability as the final position information of the pedestrian when the ratio of the first movement probability to the second movement probability is greater than the third preset threshold.
作为一种可选实施例,确定单元,用于对于室内环境地图模型中任一相邻预设节点,根据任一相邻预设节点的位置信息,计算行人移动至任一相邻预设节点的发射概率;根据运动识别概率矩阵,确定任一相邻预设节点的运动状态表现为室内运动状态的状态识别概率;将发射概率与状态识别概率之间的乘积作为行人移动至任一相邻预设节点的移动概率。As an optional embodiment, the determining unit is configured to, for any adjacent preset node in the indoor environment map model, calculate the movement of the pedestrian to any adjacent preset node according to the position information of any adjacent preset node According to the motion recognition probability matrix, determine the state recognition probability that the motion state of any adjacent preset node represents the indoor motion state; take the product between the emission probability and the state recognition probability as a pedestrian moving to any adjacent node The movement probability of the preset node.
作为一种可选实施例,校准模块303,还包括:As an optional embodiment, the calibration module 303 further includes:
第二比较单元,用于当第一移动概率与第二移动概率的比值不大于第三预设阈值时,将预测得到的行人位置信息作为行人的最终位置信息。The second comparison unit is configured to use the predicted pedestrian position information as the pedestrian's final position information when the ratio of the first movement probability to the second movement probability is not greater than the third preset threshold.
本发明实施例提供的装置,通过根据多重传感器采集到的数据,预测行人的位置信息。基于室内运动模型,获取行人的室内运动状态。基于室内环境地图模型,根据室内运动状态及室内预设节点的位置信息,对预测得到的行人位置信息进行校准,得到行人的最终位置信息。由于不用安装外部设备,从而在避免设计复杂度较高的系统的同时,还可减少硬件成本消耗,进而使得室内定位时耗费的成本较低。The device provided by the embodiment of the present invention predicts the location information of pedestrians by using data collected by multiple sensors. Based on the indoor motion model, the indoor motion state of the pedestrian is obtained. Based on the indoor environment map model, the predicted pedestrian position information is calibrated according to the indoor motion state and the position information of the indoor preset nodes, and the final position information of the pedestrian is obtained. Since there is no need to install external equipment, while avoiding designing a system with high complexity, the hardware cost consumption can also be reduced, so that the cost of indoor positioning is lower.
另外,由于进行运动特征分类时,选取了加速度计、气压计和陀螺仪数据,提高了运动特征分类时的准确性,同时能够避免长时间累积误差的出现。由于定位过程将行人航位推测算法、室内行人运动特征以及隐马尔科夫模型匹配方法结合在了一起,从而在保证较高定位准确率的同时,还可以提升室内定位的鲁棒性。In addition, the accelerometer, barometer and gyroscope data are selected during the classification of motion features, which improves the accuracy of classification of motion features and avoids the occurrence of long-term accumulated errors. Since the positioning process combines the pedestrian dead reckoning algorithm, the indoor pedestrian motion feature and the hidden Markov model matching method, the robustness of indoor positioning can be improved while ensuring a high positioning accuracy.
最后,本申请的方法仅为较佳的实施方案,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。Finally, the method of the present application is only a preferred embodiment, and is not intended to limit the protection scope of the present invention. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included within the protection scope of the present invention.
Claims (6)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611070529.6A CN106595633B (en) | 2016-11-25 | 2016-11-25 | Indoor positioning method and device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611070529.6A CN106595633B (en) | 2016-11-25 | 2016-11-25 | Indoor positioning method and device |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106595633A CN106595633A (en) | 2017-04-26 |
CN106595633B true CN106595633B (en) | 2019-07-19 |
Family
ID=58595552
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611070529.6A Active CN106595633B (en) | 2016-11-25 | 2016-11-25 | Indoor positioning method and device |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106595633B (en) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107063268A (en) * | 2017-06-05 | 2017-08-18 | 合肥展游软件开发有限公司 | A kind of museum's navigation system and application method |
CN110692260B (en) | 2017-06-30 | 2021-08-17 | 北京嘀嘀无限科技发展有限公司 | Terminal equipment positioning system and method |
CN107356229B (en) * | 2017-07-07 | 2021-01-05 | 中国电子科技集团公司电子科学研究院 | Indoor positioning method and device |
CN109413683B (en) | 2017-08-15 | 2021-09-21 | 华为技术有限公司 | Method and device for acquiring emission probability, transition probability and sequence positioning |
CN108645406A (en) * | 2018-04-19 | 2018-10-12 | 北京理工大学 | A kind of indoor autonomic positioning method based on score field pedestrian movement perception |
CN109991641A (en) * | 2019-04-10 | 2019-07-09 | 广东工业大学 | A method, device and system for obtaining location information of a mobile device |
CN111854753B (en) * | 2020-06-02 | 2023-05-23 | 深圳全景空间工业有限公司 | A Modeling Method for Indoor Space |
CN115336936B (en) * | 2021-05-12 | 2025-02-18 | 尚科宁家(中国)科技有限公司 | A control method for a cleaning robot crossing floors and a cleaning robot |
CN115223442B (en) * | 2021-07-22 | 2024-04-09 | 上海数川数据科技有限公司 | Automatic generation method of indoor pedestrian map |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102821464A (en) * | 2012-08-13 | 2012-12-12 | 北京邮电大学 | Indoor storey positioning method and device |
CN103701991A (en) * | 2013-12-20 | 2014-04-02 | 百度在线网络技术(北京)有限公司 | Mobile terminal state recognition method and mobile terminal |
CN104215238A (en) * | 2014-08-21 | 2014-12-17 | 北京空间飞行器总体设计部 | Indoor positioning method of intelligent mobile phone |
CN104977006A (en) * | 2015-08-11 | 2015-10-14 | 北京纳尔信通科技有限公司 | Indoor positioning method based on fuzzy theory and multi-sensor fusion |
CN105004343A (en) * | 2015-07-27 | 2015-10-28 | 上海美琦浦悦通讯科技有限公司 | Indoor wireless navigation system and method |
CN105509736A (en) * | 2015-12-03 | 2016-04-20 | 北京机械设备研究所 | Indoor composite locating method for fire rescue |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI397671B (en) * | 2009-12-16 | 2013-06-01 | Ind Tech Res Inst | System and method for locating carrier, estimating carrier posture and building map |
-
2016
- 2016-11-25 CN CN201611070529.6A patent/CN106595633B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102821464A (en) * | 2012-08-13 | 2012-12-12 | 北京邮电大学 | Indoor storey positioning method and device |
CN103701991A (en) * | 2013-12-20 | 2014-04-02 | 百度在线网络技术(北京)有限公司 | Mobile terminal state recognition method and mobile terminal |
CN104215238A (en) * | 2014-08-21 | 2014-12-17 | 北京空间飞行器总体设计部 | Indoor positioning method of intelligent mobile phone |
CN105004343A (en) * | 2015-07-27 | 2015-10-28 | 上海美琦浦悦通讯科技有限公司 | Indoor wireless navigation system and method |
CN104977006A (en) * | 2015-08-11 | 2015-10-14 | 北京纳尔信通科技有限公司 | Indoor positioning method based on fuzzy theory and multi-sensor fusion |
CN105509736A (en) * | 2015-12-03 | 2016-04-20 | 北京机械设备研究所 | Indoor composite locating method for fire rescue |
Non-Patent Citations (2)
Title |
---|
Smartphone based Indoor Position and Orientation Tracking Fusing Inertial and Magnetic Sensing;Chengkai Huang 等;《17th International Symposium on Wireless Personal Multimedia Communications》;20141231;第205-220页 |
基于粒子滤波的智能移动终端室内定位方法研究;闫亭亭;《中国优秀硕士学位论文全文数据库 信息科技辑》;20140815(第08期);I136-293 |
Also Published As
Publication number | Publication date |
---|---|
CN106595633A (en) | 2017-04-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106595633B (en) | Indoor positioning method and device | |
Abdelnasser et al. | SemanticSLAM: Using environment landmarks for unsupervised indoor localization | |
CN104501796B (en) | A kind of interior WLAN/MEMS merges across floor 3-dimensional localization method | |
Zhou et al. | ALIMC: Activity landmark-based indoor mapping via crowdsourcing | |
Zhou et al. | Activity sequence-based indoor pedestrian localization using smartphones | |
JP6295250B2 (en) | Method and apparatus for positioning | |
KR101322778B1 (en) | Method and apparatus for identification of points of interest within a predefined area | |
US9462423B1 (en) | Qualitative and quantitative sensor fusion for indoor navigation | |
CN109164411B (en) | A Person Location Method Based on Multi-data Fusion | |
CN108140052A (en) | Computing system and its operating method with structural vertical level mechanism | |
Wang et al. | Recent advances in pedestrian inertial navigation based on smartphone: A review | |
Zhang et al. | CIMLoc: A crowdsourcing indoor digital map construction system for localization | |
Xu et al. | A robust floor localization method using inertial and barometer measurements | |
JP2013531781A (en) | Method and system for detecting zero speed state of object | |
Lee et al. | An indoor localization solution using Bluetooth RSSI and multiple sensors on a smartphone | |
Pipelidis et al. | A novel lightweight particle filter for indoor localization | |
CN106197418B (en) | An Indoor Positioning Method Based on Sliding Window Fingerprint Method and Sensor Fusion | |
Gu et al. | Efficient and accurate indoor localization using landmark graphs | |
Gu et al. | Integration of positioning and activity context information for lifelog in urban city area | |
CN107289924A (en) | A kind of map adaptive method for switching based on positional information | |
Pei et al. | Motion recognition assisted indoor wireless navigation on a mobile phone | |
CN117098224A (en) | Indoor positioning and navigation method based on WiFi fingerprint and inertial sensor information fusion | |
Lin et al. | Multi-floor indoor localization scheme using a Seq2Seq-based floor detection and particle filter with clustering | |
Pei et al. | Using motion-awareness for the 3D indoor personal navigation on a Smartphone | |
Elhamshary et al. | Towards ubiquitous indoor spatial awareness on a worldwide scale |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |