CN115406435A - Indoor electronic map construction method and device based on WLAN and MEMS and storage medium - Google Patents
Indoor electronic map construction method and device based on WLAN and MEMS and storage medium Download PDFInfo
- Publication number
- CN115406435A CN115406435A CN202211020410.3A CN202211020410A CN115406435A CN 115406435 A CN115406435 A CN 115406435A CN 202211020410 A CN202211020410 A CN 202211020410A CN 115406435 A CN115406435 A CN 115406435A
- Authority
- CN
- China
- Prior art keywords
- wlan
- mems
- sensor
- acceleration
- coordinates
- 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.)
- Granted
Links
- 238000003860 storage Methods 0.000 title claims abstract description 10
- 238000010276 construction Methods 0.000 title claims description 11
- 230000033001 locomotion Effects 0.000 claims abstract description 27
- 238000000034 method Methods 0.000 claims abstract description 24
- 238000005070 sampling Methods 0.000 claims abstract description 16
- 238000013507 mapping Methods 0.000 claims abstract description 13
- 238000005259 measurement Methods 0.000 claims abstract description 8
- 230000001360 synchronised effect Effects 0.000 claims abstract description 4
- 230000001133 acceleration Effects 0.000 claims description 63
- 230000005484 gravity Effects 0.000 claims description 11
- 238000012937 correction Methods 0.000 claims description 10
- 238000001914 filtration Methods 0.000 claims description 6
- 238000004458 analytical method Methods 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000000737 periodic effect Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 4
- 230000003068 static effect Effects 0.000 description 3
- 239000013598 vector Substances 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000005021 gait Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000012549 training Methods 0.000 description 2
- 241001465754 Metazoa Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000012625 in-situ measurement Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 235000013550 pizza Nutrition 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3807—Creation or updating of map data characterised by the type of data
- G01C21/383—Indoor data
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/18—Stabilised platforms, e.g. by gyroscope
-
- 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
-
- 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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3833—Creation or updating of map data characterised by the source of data
- G01C21/3841—Data obtained from two or more sources, e.g. probe vehicles
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/023—Services making use of location information using mutual or relative location information between multiple location based services [LBS] targets or of distance thresholds
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/33—Services specially adapted for particular environments, situations or purposes for indoor environments, e.g. buildings
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Navigation (AREA)
Abstract
The invention relates to a method, a device and a storage medium for constructing an indoor electronic map based on WLAN and MEMS, wherein the method comprises the following steps: step 1) in an off-line stage, based on a dynamic field mapping mode, utilizing an MEMS sensor of an intelligent mobile terminal to obtain motion auxiliary data, utilizing a WLAN sensor to obtain RSSI fingerprint measurement, and based on the motion auxiliary data, generating a motion track by adopting a pedestrian dead reckoning algorithm; step 2) calibrating the motion track based on the indoor landmarks, wherein the indoor landmarks comprise corridor corners and stairways between floors; and 3) matching the three-dimensional coordinates of the sampling points in the calibrated motion track and the RSSI fingerprints through the synchronous time stamps to obtain a complete indoor electronic map containing a plurality of floors. Compared with the prior art, the method has the advantages that the electronic map is built by utilizing the low-cost sensor, the built track precision is high, and the like.
Description
Technical Field
The invention relates to an electronic map construction method, in particular to an indoor electronic map construction method, device and storage medium based on WLAN and MEMS.
Background
Due to the wide application of mobile intelligent terminals and the rapid popularization and mass application of wireless networks, the application demand Based on Location Based Services (LBS) is on a rapid and greatly increased trend, and the LBS is rapidly developed and popularized to various fields of social life and production. Among them, reliable and efficient positioning technology is the premise and key point for implementing LBS.
In the outdoors, a Global Navigation Satellite System (GNSS) is used in various fields requiring information of positioning services. The GNSS generation and development basically solve the problem of positioning in outdoor open space, and is widely applied in the fields of military affairs, traffic, resource environment, agriculture, animal husbandry, fishery, mapping and the like and in daily life of people; although this technique works well in outdoor applications, the performance of GNSS based positioning systems is not satisfactory in indoor applications. Therefore, in an indoor environment, research of specialized positioning methods and techniques is an inevitable trend of the development of the current LBS applications.
In the 90's of the 20 th century, a high-speed wireless network communication technology, namely Wireless Local Area Network (WLAN), began to develop rapidly. The WLAN has the characteristics of high communication speed and convenience in deployment, so that the WLAN has wide application potential and prospect in the field of indoor positioning. Among the general WLAN-based indoor positioning methods, the Received Signal Strength Indication (RSSI) -based fingerprinting is the most interesting method with its high accuracy and low cost. Location based on RSSI fingerprints is typically performed in two phases. In the off-line phase, field mapping is performed, collecting Received Signal Strength Indicator (RSSI) vectors from different Access Points (APs) of known location, which are called Reference Points (RPs). These vectors of RSSI form a fingerprint for each station and are stored in a database, otherwise known as a Radio Map (RM). Thus, the offline phase is a database building process. In the online phase, the user or target measures the RSSI vector at its location and reports it to the server, which estimates and returns the user's location.
An important drawback that hinders large-scale deployment of existing indoor positioning systems is the time and labor consuming nature of the field survey. When the electronic map is constructed in an off-line stage, special field mapping needs to be carried out on the reference points, the positions and the signal intensity of the reference points need to be manually measured, and the positions and the signal intensity need to be matched to form position fingerprints. Furthermore, location dependent radio maps need to be updated regularly to adapt to changes in the environment, which significantly burdens the location system. Taking an airport as an example, for a survey area of 8000 square meters, if 2 meters are selected as the grid size for the site survey, there are still 2000 reference points to be surveyed on site. Therefore, reducing the in-situ measurement density or considering the trade-off between cost and accuracy is an important issue for current fingerprint localization.
Disclosure of Invention
The invention aims to provide an indoor electronic map construction method, device and storage medium based on WLAN and MEMS, which adopts a low-cost sensor to realize high-precision electronic map construction, thereby reducing cost and ensuring higher track precision.
The purpose of the invention can be realized by the following technical scheme:
an indoor electronic map construction method based on WLAN and MEMS comprises the following steps:
step 1) in an off-line stage, based on a dynamic field mapping mode, utilizing an MEMS sensor of an intelligent mobile terminal to obtain motion auxiliary data, utilizing a WLAN sensor to obtain RSSI fingerprint measurement, and based on the motion auxiliary data, generating a motion track by adopting a pedestrian dead reckoning algorithm;
step 2) calibrating the motion track based on the indoor landmarks, wherein the indoor landmarks comprise corridor corners and stairways between floors;
and 3) matching the three-dimensional coordinates of the sampling points in the calibrated motion track and the RSSI fingerprints through the synchronous time stamps to obtain a complete indoor electronic map containing a plurality of floors.
The step 1) comprises the following steps:
step 1-1) obtaining a starting signal for a pedestrian to start walking, starting an MEMS sensor and a WLAN sensor of an intelligent mobile terminal based on the starting signal, and entering a step counting state, wherein the MEMS sensor comprises an acceleration sensor, a gyroscope and a magnetic sensor;
step 1-2) dividing an indoor space into a plurality of areas based on indoor landmarks, wherein the areas include a floor level and a stair area of each floor;
step 1-3) obtaining RSSI fingerprint measurement output by a WLAN sensor;
step 1-4) acquiring acceleration data output by an acceleration sensor, wherein the acceleration data are periodic data;
step 1-5) estimating the number of steps of walking based on the acceleration data and a pre-configured threshold condition;
step 1-6) estimating the step length of walking based on the acceleration data and the dynamic model;
step 1-7) acquiring the outputs of a gyroscope and a magnetic sensor and estimating a walking direction value;
step 1-8) determining the position coordinate of the next moment by combining the step length, the direction value and the step number of each step based on the initial position coordinate of walking for each area;
step 1-9) repeating the steps 1-3) -1-8) until a stop signal of stopping walking of the pedestrian is received, turning off the MEMS sensor and the WLAN sensor, and ending the step counting state;
and 1-10) connecting the position coordinates of each time in each area to generate a walking track of each area.
The step 1-5) comprises the following steps:
step 1-5-1) carrying out low-pass filtering on the triaxial data of the acceleration data to separate out the components of gravity on each axis;
step 1-5-2) eliminating gravity interference based on high-pass filtering to obtain actual acceleration data;
step 1-5-3) determining the overall acceleration based on the actual acceleration data:
wherein, (a (t) x ,a(t) y ,a(t) z ) A (t) is the overall acceleration, which is the triaxial data of the actual acceleration;
and 1-5-4) judging whether the integral acceleration of the current step meets a preset threshold condition, and if so, accumulating the step to count the number of steps.
The threshold condition comprises that the acceleration of the wave crest and the wave trough of the integral acceleration is larger than a first threshold, the time interval of two adjacent wave crests is larger than a second threshold, and the time of a complete walking cycle is larger than a third threshold, wherein the complete walking cycle comprises foot lifting, striding and landing.
And 1-6) obtaining the relation between the step length and the acceleration data by establishing the relation between the analysis step length of the human body walking dynamic model and the body displacement in each walking cycle, thereby calculating the dynamic change of the step length based on the acceleration data.
The steps 1-7) comprise the following steps:
step 1-7-1) obtaining a first direction value output by magnetometer calculation;
step 1-7-2) acquiring an angular velocity value output by a gyroscope, and integrating the angular velocity value to obtain a second direction value;
and 1-7-3) fusing the first direction value and the second direction value to obtain a direction value.
The calculation method for determining the position coordinate at the next moment in the steps 1-8) comprises the following steps:
wherein (x) t ,y t ,z t ) (x) is the current coordinate of the user t+Δt ,y t+Δt ,z t+Δt ) Is the coordinate of the next moment, n represents the number of steps in the time of delta t, l is the step size, theta is the direction value, z k Is the coordinate height of the initial floor k of the stair area, z k+1 Is the coordinate height of the next floor k + 1.
The step 2) comprises the following steps:
step 2-1) presumes that the motion track in one area consists of n sampling points (p) 1 ,p 2 ,…,p n ) Wherein the position of each sampling point corresponds to a three-dimensional coordinate, the first sampling point p 1 And the last sampling point p n Is known, let p be 1 And p n Setting as a calibration point;
step 2-2) obtaining p calculated based on pedestrian dead reckoning n Observing coordinates of points by comparing p n The observed coordinates and the real coordinates of the points are used for obtaining the closing difference f of the x, y and z coordinates x ,f y ,f z :
Wherein (x) n ,y n ,z n ) Is p n The observed coordinates of the point or points are,is p n The true coordinates of the points;
step 2-3) utilizing the closure difference f x ,f y ,f z Determining a coordinate correction value:
wherein D is selected from p 1 Point to p n Full length of the locus of points, D i-1 Is the length of the side of the track before the ith point, v xi ,v yi ,v zi Is a coordinate correction value;
step 2-4) coordinates are corrected based on the coordinate correction value, and calibration is completed:
x i ′=x i +v xi
y i ′=y i +v yi
z i ′=z i +v zi
wherein, 9x i ,y i ,z i ) To correct the three-dimensional coordinates of the ith point, (x) i ′,y i ′,z i ') is the three-dimensional coordinates of the corrected ith point.
An indoor electronic mapping device based on WLAN and MEMS comprises a memory, a processor and a program stored in the memory, wherein the processor executes the program to realize the method.
A storage medium having a program stored thereon, which when executed performs the method as described above.
Compared with the prior art, the invention has the following beneficial effects:
the invention provides an indoor electronic map construction method based on information fusion of a WLAN sensor and an MEMS sensor, which is different from the conventional heavy-duty static field measurement mode.
Drawings
FIG. 1 is a flow chart of a method of the present invention;
FIG. 2 is a floor map of an indoor environment in an embodiment where (a) is a first floor, (b) is a second floor, and (c) is a third floor;
FIG. 3 is a schematic view of acceleration triaxial data;
FIG. 4 is a graphical depiction of the trajectory of multiple zones prior to calibration in an embodiment wherein (a) is a first floor, (b) is a second floor, and (c) is a third floor;
FIG. 5 is a plot of calibrated multiple zones for an embodiment where (a) is a first floor, (b) is a second floor, and (c) is a third floor;
FIG. 6 is a diagram illustrating merged tracks for multiple regions, in accordance with an embodiment;
FIG. 7 is a schematic electronic map of various areas in an embodiment where (a) is a first floor, (b) is a second floor, and (c) is a third floor;
fig. 8 is a schematic diagram of a complete indoor electronic map according to an embodiment.
Detailed Description
The invention is described in detail below with reference to the figures and specific embodiments. The present embodiment is implemented on the premise of the technical solution of the present invention, and a detailed implementation manner and a specific operation process are given, but the scope of the present invention is not limited to the following embodiments.
This example was tested using a multi-story building at the university of Jaume I, with experimental data provided by the IPIN2019 indoor location competition collected at the CNR (pizza, italy) facility, with an indoor environment floor map of the building as shown in FIG. 2.
An indoor electronic map construction method based on WLAN and MEMS, as shown in fig. 1, includes the following steps:
step 1) in an off-line stage, based on a dynamic field mapping mode, an MEMS sensor of an intelligent mobile terminal is used for obtaining motion auxiliary data, an RSSI fingerprint measurement is obtained through a WLAN sensor, and based on the motion auxiliary data, a Pedestrian Dead Reckoning (PDR) is adopted for generating a motion track.
Step 1-1) obtaining a starting signal for a pedestrian to start walking, starting an MEMS sensor and a WLAN sensor of an intelligent mobile terminal based on the starting signal, and entering a step counting state, wherein the MEMS sensor comprises an acceleration sensor, a gyroscope and a magnetic sensor;
step 1-2) dividing an indoor space into a plurality of areas based on indoor landmarks, wherein the areas comprise floor planes and stair areas of each floor;
in this embodiment, data acquisition of a motion trajectory starts at one calibration point and ends at another calibration point, which is determined based on indoor landmarks.
Step 1-3) obtaining RSSI fingerprint measurement output by a WLAN sensor;
step 1-4) acquiring acceleration data output by an acceleration sensor, wherein the acceleration data are periodic data, and are shown in FIG. 3;
step 1-5) estimating the number of steps of walking based on the acceleration data and a pre-configured threshold condition;
the walking gait of the pedestrian comprises lifting, striding and landing, the acceleration in each direction is represented as the alternate transformation of wave crest and wave trough curves, and the acceleration has certain regularity and periodicity. The acceleration data is shown in fig. 3. Therefore, the detection of the number of steps can be realized by using an acceleration sensor. The original output data of the mobile phone MEMS acceleration sensor contains the gravity component of the earth, and the gravity acceleration component caused by different mobile phone placing posture differences is not fixed, so that the acceleration on each axis loses the original regularity, and therefore the gravity component needs to be removed from each axis of the acceleration data before step detection. The gravity changes only when the equipment rotates, and belongs to a low-frequency signal. Therefore, the gravity interference can be eliminated through the following steps, and the actual acceleration value is obtained.
Step 1-5-1) carrying out low-pass filtering on the triaxial data of the acceleration data to separate out the components of gravity on each axis;
step 1-5-2) eliminating gravity interference based on high-pass filtering to obtain actual acceleration data;
step 1-5-3) it can be seen from fig. 3 that the waveforms output by the acceleration sensor in three axes all have a certain periodicity, but none are very obvious, so that the overall acceleration is determined based on the actual acceleration data, and the analysis is performed with the overall acceleration as a sample:
wherein, (a (t) x ,a(t) y ,a(t) z ) A (t) is the three-axis data of the actual acceleration, and a (t) is the integral acceleration;
and 1-5-4) judging whether the integral acceleration of the current step meets all threshold conditions, and if so, accumulating the step to count the number of steps.
The threshold condition comprises that the acceleration of the wave crest and the wave trough of the integral acceleration is larger than a first threshold, the time interval of two adjacent wave crests is larger than a second threshold, and the time of a complete walking cycle is larger than a third threshold, wherein the complete walking cycle comprises foot lifting, striding and landing.
Step 1-6) estimating the step length of walking based on the acceleration data and the dynamic model;
the step size is typically estimated using a static model or a dynamic model as the pedestrian progresses. The static model fixes the step length, divides the step length into a plurality of grades according to the sex, the height and the walking state of the human body, and obtains the corresponding step length value according to the actual condition of the pedestrian, or directly takes the step length obtained in the training mode as the step length of the pedestrian in actual walking. The step length estimation method is simple and reliable under the condition that the pedestrian walks at a constant speed, but the step length estimation method is more accurate by using a dynamic model in consideration of the gait complexity and the variable speed movement condition of the human body during walking. The invention obtains the relation between the step length and the acceleration data by establishing the relation between the human body walking dynamic model analysis step length and the body displacement in each walking period, thereby calculating the dynamic change of the step length based on the acceleration data.
Step 1-7) acquiring the outputs of a gyroscope and a magnetic sensor and estimating a walking direction value;
after the pedestrian is judged to finish the walking step and the step length of the step is estimated, the PDR algorithm can be finished only by knowing the motion direction of the pedestrian. In view of the sensor characteristics described above, the orientation data calculated by the magnetometer remains stable over time. However, when there is strong magnetic interference in the indoor environment, the magnetometer data will be severely distorted, resulting in a certain degree of azimuth deviation. The gyroscope is not affected by magnetic interference, and accurate azimuth data can be obtained by integrating the angular velocity of the output in a short time. However, errors due to self-data drift accumulate over time, and the resulting orientation is the position relative to the initial orientation. Therefore, the invention integrates the magnetometer and the gyroscope to jointly estimate the direction of the pedestrian, thereby reducing the influence caused by magnetic interference signals in the room and drift errors of the gyroscope and obtaining more reliable direction angle information.
Step 1-7-1) acquiring a first direction value calculated and output by a magnetometer;
step 1-7-2) acquiring an angular velocity value output by a gyroscope, and integrating the angular velocity value to obtain a second direction value;
and 1-7-3) fusing the first direction value and the second direction value to obtain a direction value.
Step 1-8) determining the position coordinate of the next moment by combining the step length, the direction value and the step number of each step based on the initial position coordinate of walking for each area:
wherein (x) t ,y t ,z t ) As the current coordinates of the user, (x) t+Δt ,y t+Δt ,z t+Δt ) Is the coordinate of the next time, n represents the number of steps in the time of delta t, l is the step size, theta is the direction value, z k Is the coordinate height of the starting floor k of the stair area, z k+1 Is the coordinate height of the next floor k + 1.
Step 1-9) repeating the steps 1-3) -1-8) until a stop signal of stopping walking of the pedestrian is received, turning off the MEMS sensor and the WLAN sensor, and ending the step counting state;
and 1-10) connecting the position coordinates of each time in each area to generate a walking track of each area.
The motion trajectories of the plurality of regions obtained based on the above steps are shown in fig. 4.
And 2) calibrating the motion track based on the indoor landmarks, wherein the indoor landmarks comprise corridor corners and stairways between floors.
Step 2-1) supposing that the motion track in one area consists of n sampling points (p) 1 ,p 2 ,…,p n ) Wherein the position of each sampling point corresponds to a three-dimensional coordinate, the first sampling point p 1 And the last sampling point p n Is known, let p be 1 And p n Setting as a calibration point;
step 2-2) obtaining p calculated based on pedestrian dead reckoning n Observing coordinates of points by comparing p n The observed coordinates and the real coordinates of the points are used for obtaining the closing difference f of the x, y and z coordinates x ,f y ,f z :
Wherein, 9x n ,y n ,z n ) Is p n The observed coordinates of the point or points are,is p n The true coordinates of the points;
step 2-3) utilizing the closure difference f x ,f y ,f z Determining a coordinate correction value:
wherein D is selected from p 1 Point to p n Full length of the locus of points, D i-1 Is the length of the side of the track before the ith point, v xi ,v yi ,v zi Is a coordinate correction value;
step 2-4) coordinates are corrected based on the coordinate correction value, and calibration is completed:
x i ′=x i +v xi
y i ′=y i +v yi
z i ′=z i +v zi
wherein (x) i ,y i ,z i ) Is composed ofThree-dimensional coordinates of the ith point before correction, (x) i ′,y i ′,z i ') is the three-dimensional coordinates of the corrected ith point.
The calibrated trajectory diagram is shown in fig. 5, and compared with fig. 4, the invention can greatly improve the accuracy of the trajectory based on the constraint of the indoor landmark.
The schematic diagram of the overall trajectory obtained by drawing the area trajectories for all the data in the training set and combining the area trajectories is shown in fig. 6, where in fig. 6, the dashed line represents the trajectory of the stair area, and the solid line represents the trajectory of the floor plane.
And 3) matching the three-dimensional coordinates of the sampling points in the calibrated motion track and the RSSI fingerprints through the synchronous time stamps to obtain a complete indoor electronic map containing a plurality of floors.
Each received WiFi fingerprint is bound with a position coordinate in the track according to a timestamp to serve as a Reference Point (RP), an electronic map corresponding to each floor is obtained as shown in fig. 7, and a complete indoor electronic map containing multiple floors is shown in fig. 8. All reference points in the figure are evenly distributed in the corridor of the building.
The above functions, if implemented in the form of software functional units and sold or used as a separate product, may be stored in a computer-readable storage medium. Based on such understanding, the technical solution of the present invention may be embodied in the form of a software product, which is stored in a storage medium and includes instructions for causing a computer device (which may be a personal computer, a server, or a network device) to execute all or part of the steps of the method according to the embodiments of the present invention. And the aforementioned storage medium includes: a U-disk, a removable hard disk, a Read-Only Memory (ROM), a Random Access Memory (RAM), a magnetic disk or an optical disk, and other various media capable of storing program codes.
The foregoing detailed description of the preferred embodiments of the invention has been presented. It should be understood that numerous modifications and variations could be devised by those skilled in the art in light of the present teachings without departing from the inventive concepts. Therefore, the technical solutions that can be obtained by a person skilled in the art through logic analysis, reasoning or limited experiments based on the prior art according to the concept of the present invention should be within the scope of protection defined by the claims.
Claims (10)
1. An indoor electronic map construction method based on WLAN and MEMS is characterized by comprising the following steps:
step 1) in an off-line stage, based on a dynamic field mapping mode, utilizing an MEMS sensor of an intelligent mobile terminal to obtain motion auxiliary data, utilizing a WLAN sensor to obtain RSSI fingerprint measurement, and based on the motion auxiliary data, generating a motion track by adopting a pedestrian dead reckoning algorithm;
step 2) calibrating the motion track based on the indoor landmarks, wherein the indoor landmarks comprise corridor corners and stairways between floors;
and 3) matching the three-dimensional coordinates of the sampling points in the calibrated motion track and the RSSI fingerprints through the synchronous time stamps to obtain a complete indoor electronic map containing a plurality of floors.
2. An indoor electronic mapping method based on WLAN and MEMS according to claim 1, wherein said step 1) comprises the following steps:
step 1-1) obtaining a starting signal for a pedestrian to start walking, starting an MEMS sensor and a WLAN sensor of an intelligent mobile terminal based on the starting signal, and entering a step counting state, wherein the MEMS sensor comprises an acceleration sensor, a gyroscope and a magnetic sensor;
step 1-2) dividing an indoor space into a plurality of areas based on indoor landmarks, wherein the areas comprise floor planes and stair areas of each floor;
step 1-3) obtaining RSSI fingerprint measurement output by a WLAN sensor;
step 1-4) acquiring acceleration data output by an acceleration sensor, wherein the acceleration data are periodic data;
step 1-5) estimating the number of steps of walking based on the acceleration data and a preconfigured threshold condition;
step 1-6) estimating the step length of walking based on the acceleration data and the dynamic model;
step 1-7) acquiring the outputs of a gyroscope and a magnetic sensor and estimating a walking direction value;
step 1-8) determining the position coordinate of the next moment based on the initial position coordinate of walking and the step length, the direction value and the step number of each step aiming at each area;
step 1-9) repeating the steps 1-3) -1-8) until a stop signal of stopping walking of the pedestrian is received, turning off the MEMS sensor and the WLAN sensor, and ending the step counting state;
and 1-10) connecting the position coordinates of each moment in each area to generate a walking track of each area.
3. A WLAN and MEMS based indoor electronic mapping method according to claim 2, wherein the steps 1-5) include the steps of:
step 1-5-1) carrying out low-pass filtering on the triaxial data of the acceleration data to separate out the components of gravity on each axis;
step 1-5-2) eliminating gravity interference based on high-pass filtering to obtain actual acceleration data;
step 1-5-3) determining the overall acceleration based on the actual acceleration data:
wherein, (a (t) x ,a(t) y ,a(t) z ) A (t) is the overall acceleration, which is the triaxial data of the actual acceleration;
and 1-5-4) judging whether the integral acceleration of the current step meets a preset threshold condition, and if so, accumulating the step to count the number of steps.
4. The WLAN and MEMS based indoor electronic map building method of claim 3, wherein the threshold condition includes that the acceleration magnitude of the whole acceleration peak and the valley is larger than a first threshold, the time interval between two adjacent peaks is larger than a second threshold, and the time of one complete walking cycle is larger than a third threshold, wherein the complete walking cycle includes lifting foot, striding and landing.
5. The method as claimed in claim 2, wherein the step 1-6) obtains the relationship between the step size and the acceleration data by establishing the relationship between the step size and the body displacement in each walking cycle through dynamic model analysis of human walking, so as to estimate the dynamic change of the step size based on the acceleration data.
6. A WLAN and MEMS based indoor electronic mapping method according to claim 2, wherein the steps 1-7) include the steps of:
step 1-7-1) acquiring a first direction value calculated and output by a magnetometer;
step 1-7-2) obtaining an angular velocity value output by a gyroscope, and integrating the angular velocity value to obtain a second direction value;
and 1-7-3) fusing the first direction value and the second direction value to obtain a direction value.
7. An indoor electronic map construction method based on WLAN and MEMS according to claim 2, characterized in that the calculation method of determining the position coordinates of the next time in the steps 1-8) is:
wherein (x) t ,y t ,z t ) Is the current coordinates of the user, (z) t+Δt ,y t+Δt ,z t+Δt ) Is the coordinate of the next moment, n represents the number of steps in the time of delta t, l is the step size, theta is the direction value, z k Is the coordinate height of the starting floor k of the stair area, z k+1 Is the coordinate height of the next floor k + 1.
8. The WLAN and MEMS based indoor electronic mapping method of claim 1, wherein the step 2) comprises the steps of:
step 2-1) presumes that the motion track in one area consists of n sampling points (p) 1 ,p 2 ,…,p n ) The position of each sampling point corresponds to a three-dimensional coordinate, and the first sampling point p 1 And the last sampling point p n Is known, let p be 1 And p n Setting as a calibration point;
step 2-2) obtaining p calculated based on pedestrian dead reckoning n Observing coordinates of points by comparing p n The observed coordinates and the real coordinates of the points are used for obtaining the closing difference f of the x, y and z coordinates x ,f y ,f z :
Wherein (x) n ,y n ,z n ) Is p n Observed coordinates of points,Is p n The true coordinates of the points;
step 2-3) utilizing the closure difference f x ,f y ,f z Determining a coordinate correction value:
wherein D is selected from p 1 Point to p n Full length of locus of points, D i-1 Is the length of the side of the track before the ith point, v xi ,v yi ,v zi Is a coordinate correction value;
step 2-4) coordinates are corrected based on the coordinate correction value, and calibration is completed:
x i ′=x i +v xi
y i ′=y i +v yi
z i ′=z i +v zi
wherein (x) i ,y i ,z i ) To correct the three-dimensional coordinates of the ith point, (x) i ′,y i ′,z i ') is the three-dimensional coordinates of the corrected ith point.
9. An indoor electronic mapping device based on WLAN and MEMS, comprising a memory, a processor, and a program stored in the memory, wherein the processor when executing the program implements the method according to any of claims 1-8.
10. A storage medium having a program stored thereon, wherein the program, when executed, implements the method of any of claims 1-8.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211020410.3A CN115406435B (en) | 2022-08-24 | 2022-08-24 | Indoor electronic map construction method, device and storage medium based on WLAN and MEMS |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211020410.3A CN115406435B (en) | 2022-08-24 | 2022-08-24 | Indoor electronic map construction method, device and storage medium based on WLAN and MEMS |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115406435A true CN115406435A (en) | 2022-11-29 |
CN115406435B CN115406435B (en) | 2024-07-23 |
Family
ID=84160691
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211020410.3A Active CN115406435B (en) | 2022-08-24 | 2022-08-24 | Indoor electronic map construction method, device and storage medium based on WLAN and MEMS |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115406435B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117308925A (en) * | 2023-11-29 | 2023-12-29 | 中国人民解放军国防科技大学 | Navigation method, device, equipment and medium for spectral map inertial navigation combination |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104197945A (en) * | 2014-08-27 | 2014-12-10 | 浙江工业大学 | Global voting map matching method based on low-sampling-rate floating vehicle data |
CN104567860A (en) * | 2014-12-29 | 2015-04-29 | 深圳市科松电子有限公司 | Robot autonomous-navigation method, device and system |
CN104655137A (en) * | 2015-03-05 | 2015-05-27 | 中国人民解放军国防科学技术大学 | Wi-Fi signal fingerprint positioning algorithm for assisting in speculating flight tracks of pedestrians |
CN106441292A (en) * | 2016-09-28 | 2017-02-22 | 哈尔滨工业大学 | Building indoor planar graph establishing method based on crowdsourcing IMU inertial navigation data |
WO2017180698A1 (en) * | 2016-04-14 | 2017-10-19 | Origin Wireless, Inc. | Methods, apparatus, servers, and systems for object tracking |
CN108700421A (en) * | 2015-12-21 | 2018-10-23 | 应美盛股份有限公司 | Use the method and system of the portable navigation of offline cartographic information auxiliary enhancing |
CN108919177A (en) * | 2018-07-16 | 2018-11-30 | 华中科技大学 | A kind of positioning map construction method based on virtual information source estimation and trajectory corrector |
CN110345939A (en) * | 2019-07-02 | 2019-10-18 | 山东科技大学 | A kind of indoor orientation method merging fuzzy logic judgement and cartographic information |
US20190373413A1 (en) * | 2018-06-01 | 2019-12-05 | Apple Inc. | Feature-based slam with z-axis location |
CN113295158A (en) * | 2021-05-14 | 2021-08-24 | 江苏大学 | Indoor positioning method fusing inertial data, map information and pedestrian motion state |
CN113547522A (en) * | 2021-07-30 | 2021-10-26 | 山东大学 | Robot path precision compensation method and system |
CN113984039A (en) * | 2021-10-21 | 2022-01-28 | 广东高驰运动科技有限公司 | Method, device and system for correcting motion trail and storage medium |
-
2022
- 2022-08-24 CN CN202211020410.3A patent/CN115406435B/en active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104197945A (en) * | 2014-08-27 | 2014-12-10 | 浙江工业大学 | Global voting map matching method based on low-sampling-rate floating vehicle data |
CN104567860A (en) * | 2014-12-29 | 2015-04-29 | 深圳市科松电子有限公司 | Robot autonomous-navigation method, device and system |
CN104655137A (en) * | 2015-03-05 | 2015-05-27 | 中国人民解放军国防科学技术大学 | Wi-Fi signal fingerprint positioning algorithm for assisting in speculating flight tracks of pedestrians |
CN108700421A (en) * | 2015-12-21 | 2018-10-23 | 应美盛股份有限公司 | Use the method and system of the portable navigation of offline cartographic information auxiliary enhancing |
WO2017180698A1 (en) * | 2016-04-14 | 2017-10-19 | Origin Wireless, Inc. | Methods, apparatus, servers, and systems for object tracking |
CN106441292A (en) * | 2016-09-28 | 2017-02-22 | 哈尔滨工业大学 | Building indoor planar graph establishing method based on crowdsourcing IMU inertial navigation data |
US20190373413A1 (en) * | 2018-06-01 | 2019-12-05 | Apple Inc. | Feature-based slam with z-axis location |
CN108919177A (en) * | 2018-07-16 | 2018-11-30 | 华中科技大学 | A kind of positioning map construction method based on virtual information source estimation and trajectory corrector |
CN110345939A (en) * | 2019-07-02 | 2019-10-18 | 山东科技大学 | A kind of indoor orientation method merging fuzzy logic judgement and cartographic information |
CN113295158A (en) * | 2021-05-14 | 2021-08-24 | 江苏大学 | Indoor positioning method fusing inertial data, map information and pedestrian motion state |
CN113547522A (en) * | 2021-07-30 | 2021-10-26 | 山东大学 | Robot path precision compensation method and system |
CN113984039A (en) * | 2021-10-21 | 2022-01-28 | 广东高驰运动科技有限公司 | Method, device and system for correcting motion trail and storage medium |
Non-Patent Citations (4)
Title |
---|
LING YANG等: "Seamless pedestrian navigation augmented by walk status detection and context features", 《2016 FOURTH INTERNATIONAL CONFERENCE ON UBIQUITOUS POSITIONING, INDOOR NAVIGATION AND LOCATION BASED SERVICES (UPINLBS)》, 9 January 2017 (2017-01-09) * |
曹智妮: "众包模式下位置指纹库构建的研究与应用", 《中国优秀硕士学位论文全文数据库 信息科技辑》, no. 1, 15 January 2022 (2022-01-15), pages 136 - 843 * |
贾铮洋: "基于GNSS/MIMU的室内外无缝定位算法研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》, no. 5, 15 May 2019 (2019-05-15), pages 136 - 675 * |
邓世均: "基于众包采集的室内WiFi指纹地图的研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》, no. 3, 15 March 2022 (2022-03-15), pages 136 - 729 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117308925A (en) * | 2023-11-29 | 2023-12-29 | 中国人民解放军国防科技大学 | Navigation method, device, equipment and medium for spectral map inertial navigation combination |
CN117308925B (en) * | 2023-11-29 | 2024-02-09 | 中国人民解放军国防科技大学 | Navigation method, device, equipment and medium for spectral map inertial navigation combination |
Also Published As
Publication number | Publication date |
---|---|
CN115406435B (en) | 2024-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110118549B (en) | Multi-source information fusion positioning method and device | |
CN109413578B (en) | Indoor positioning method based on fusion of WIFI and PDR | |
Sun et al. | Indoor positioning tightly coupled Wi-Fi FTM ranging and PDR based on the extended Kalman filter for smartphones | |
CN111829516B (en) | Autonomous pedestrian positioning method based on smart phone | |
CN109883428B (en) | High-precision positioning method fusing inertial navigation, geomagnetic and WiFi information | |
JP6054535B2 (en) | Pedestrian motion recognition based pedestrian position estimation apparatus and method | |
You et al. | Hybrid indoor positioning system for pedestrians with swinging arms based on smartphone IMU and RSSI of BLE | |
CN111970633A (en) | Indoor positioning method based on WiFi, Bluetooth and pedestrian dead reckoning fusion | |
CN109211229A (en) | A kind of personnel's indoor orientation method based on mobile phone sensor and WiFi feature | |
CN113566820B (en) | Fused pedestrian positioning method based on position fingerprint and PDR algorithm | |
CN107702712A (en) | Indoor pedestrian's combined positioning method based on inertia measurement bilayer WLAN fingerprint bases | |
CN112729301A (en) | Indoor positioning method based on multi-source data fusion | |
CN106197418A (en) | The indoor orientation method that a kind of fingerprinting based on sliding window merges with sensor | |
CN117760414B (en) | Rapid construction method of planar magnetic field fingerprint library based on mobile phone PDR | |
Zhou et al. | Wi-Fi RTT/encoder/INS-based robot indoor localization using smartphones | |
CN108801267A (en) | It is a kind of to merge the indoor without anchor point localization method of multisensor | |
CN115406435B (en) | Indoor electronic map construction method, device and storage medium based on WLAN and MEMS | |
CN105928512A (en) | Geomagnetic field-based indoor positioning method | |
Ding et al. | OGI-SLAM2: A hybrid map SLAM framework grounded in inertial-based SLAM | |
CN113325455B (en) | Method and system for tracking and determining indoor position of object | |
Wang et al. | An improved particle filter indoor fusion positioning approach based on Wi-Fi/PDR/geomagnetic field | |
Qiu et al. | Indoor geomagnetic positioning based on a joint algorithm of particle filter and dynamic time warp | |
Sun et al. | Research on Indoor Location Technology based on the Fusion of WiFi and PDR | |
Liu et al. | A calibrated-RSSI/PDR/Map intergrated system based on a novel particle filter for indoor navigation | |
Han et al. | Indoor Positioning System Based on Zigbee and Inertial System |
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 |