A zero-speed interval detection method with multiple constraints
Through the multi-condition constraint zero-speed interval detection method, the proportional relationship between MEMS-IMU and gait period is used to achieve accurate positioning of the pedestrian zero-speed interval, solving the problem of insufficient positioning error accumulation and threshold setting in inertial navigation, and improving The positioning accuracy and adaptability of pedestrian navigation.
Patent Information
- Application Number
- CN202210661225.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-06-13
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2042-06-13
AI Technical Summary
The existing pedestrian navigation positioning method based on inertial devices accumulates over time due to zero deviation error and drift error, and the zero-speed interval detection method relies on a single threshold setting and cannot be adaptively adjusted, resulting in a decrease in positioning accuracy.
The zero-speed interval detection method with multi-condition constraints is adopted to collect pedestrian foot motion information through MEMS-IMU, real-time calibration and low-pass filtering processing data, and precise positioning is used to avoid pseudo-peak problems. Small threshold amounts are designed to distinguish, and cyclic comparison and dynamic weighting calculations are used to improve detection accuracy.
Adaptive zero-speed interval detection is realized, positioning accuracy is improved, calculation complexity is reduced, and the correct recognition rate is 100%.
Smart Images

Figure CN115046548B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of pedestrian navigation and positioning, and in particular to a zero-speed interval detection method for a pedestrian navigation system with multiple condition constraints. Background Art
[0002] The pedestrian navigation positioning method based on inertial devices is the most commonly used method in the field of pedestrian navigation and positioning technology. However, due to the existence of the inherent zero bias error and drift error of the inertial device and the working method based on integration, the pedestrian navigation positioning error based on inertial devices accumulates over time, and the long-term positioning accuracy is poor. Therefore, suppressing the growth of positioning error is the basis for the operation of pedestrian inertial navigation systems.
[0003] When pedestrians walk, their feet move in a regular cycle of touching the ground - being still - lifting their feet - taking a step. Detecting the still interval can effectively correct the speed error calculated by inertia solution, significantly improving positioning accuracy. The detection of the still interval (zero-speed interval) is the prerequisite for subsequent error correction. False detection, missed detection, and misdetection will lead to a decrease in positioning accuracy. At present, the main methods for zero-speed interval detection are the threshold method and the sliding window variance method. These methods require setting a threshold, and the threshold setting method cannot be adaptively adjusted according to the change of gait, and have poor adaptability to the extraction of zero-speed intervals of pedestrian gait in actual processes. Summary of the invention
[0004] The present invention proposes a zero-speed interval detection method with multiple condition constraints, which can adaptively extract the gait cycle of pedestrian movement, detect the zero-speed interval according to the proportional relationship between the gait cycle and the zero-speed interval, and effectively improve the detection accuracy of the zero-speed interval during actual pedestrian movement.
[0005] The technical solution adopted by the present invention is:
[0006] A zero-speed interval detection method with multiple condition constraints uses MEMS-IMU to collect pedestrian back foot motion information, including the following steps:
[0007] S1: collect the angular rate data of the three-axis gyroscope and the acceleration data of the three-axis accelerometer in real time, and calibrate and low-pass filter the collected data;
[0008] S2: According to the angular velocity information and the acceleration information, the threshold Ω is set respectively zero and A zero The relationship between and is used to obtain the prediction results of the zero-speed interval and the motion interval;
[0009] S3: According to the prediction result of the motion interval, the peak acceleration sampling time and the pedestrian gait cycle are obtained, and M-1 gait cycles are traced back; where M is a set value;
[0010] S4: performing weighted calculation on the M gait cycles to obtain a predicted value of the current gait cycle;
[0011] S5: According to the proportional relationship between the predicted value of the current gait cycle and the zero-speed interval, the zero-speed interval after accurate positioning is obtained with the peak acceleration sampling moment as the starting point.
[0012] Furthermore, the calibration in step S1 includes the following steps:
[0013] Set the angular rate data output when the sampling time of the three-axis gyroscope is i to ω x (i), ω y (i), ω z (i), the acceleration data measurement value output by the triaxial accelerometer when the sampling time is i is a x (i) a y (i) a z (i) The power-on standby waiting time is T w ;
[0014] When the sampling time i is less than or equal to T w When , the average vector sum Ω of the gyroscope output on the three orthogonal axes is calculated ave and the average vector sum A of the accelerometer outputs on the three orthogonal axes ave :
[0015]
[0016]
[0017] Among them, Ω(i) represents the vector sum of the gyroscope outputs on the three orthogonal axes at time i, Ω s晦m Indicates that the sampling time i is less than or equal to the static waiting time T w All Ω i The sum of the three orthogonal axes is represented by A(i), which is the vector sum of the accelerometer outputs on the three orthogonal axes at time i. s晦m Indicates that the sampling time i is less than or equal to the static waiting time T w When all A i sum;
[0018] When the sampling time i is greater than T w When the real-time vector sum of the three-axis gyroscope and the three-axis accelerometer is calculated, the real-time vector sum of the three-axis gyroscope and the three-axis accelerometer is calculated and corresponds to the average vector sum Ω ave , A ave Do the difference to get the calibrated vector sum result Ω correct , A correct ;
[0019]
[0020] Furthermore, the prediction method of the zero speed interval and the motion interval in step S2 is:
[0021] When the real-time vector sum of the three-axis gyroscope after calibration and low-pass filtering is less than the set threshold Ω zero , and the real-time vector sum of the three-axis accelerometer after calibration and low-pass filtering is less than the set threshold A zero When both conditions are met, it is judged as a zero-speed interval, otherwise it is a motion interval.
[0022] Furthermore, the step S3 is specifically as follows:
[0023] The maximum value of the vertical accelerometer and the corresponding sampling time are found by the circular comparison method in the predicted motion interval, and the sampling time of the peak acceleration in the first M-1 predicted motion intervals is calculated respectively. The sampling time of two adjacent predicted motion intervals is subtracted to obtain M gait cycles.
[0024] Furthermore, the step S4 is specifically as follows:
[0025] The weighted dynamic time constraints are applied to each of the M gait cycles to obtain the predicted value T of the current gait cycle. p ;
[0026]
[0027] Among them, K i represents the weight coefficient of the i-th gait cycle. The later the i is, the greater the K i The larger the value of T i-1 represents the gait cycle of the i-1 predicted motion interval, T i-M Indicates the gait cycle of the iM predicted motion interval.
[0028] Furthermore, the zero speed interval T after accurate positioning in step S5 zero The calculation formula is as follows:
[0029]
[0030] Among them, P 1 is the ratio from heel contact to sole contact in a gait cycle, P 2 is the proportion of the zero-speed interval in a gait cycle, T p is the predicted value of the current gait cycle, is the sampling time corresponding to the maximum value of the vertical accelerometer.
[0031] Compared with the prior art, the present invention has the following beneficial effects:
[0032] 1) The zero-speed interval detection method realizes the division of the zero-speed interval and the motion interval by designing a small threshold value, realizes the prediction of the zero-speed interval, does not rely on a single threshold to realize the detection of the zero-speed interval, and has a good distinction effect under different gait characteristics;
[0033] 2) A cyclic comparison method is used within the predicted motion interval to find the peak value of the vertical accelerometer within the gait cycle, which effectively avoids the pseudo-peak problem in the peak detection process;
[0034] 3) A short period of time after the peak moment of the vertical accelerometer is the zero-speed interval, and there is a relatively fixed proportional relationship between the duration of the zero-speed interval and the duration of the gait cycle. By designing this ratio, the zero-speed interval during the pedestrian's walking process can be judged. The zero-speed interval detection method has a simple model, universal applicability, and low computational complexity. BRIEF DESCRIPTION OF THE DRAWINGS
[0035] Figure 1 It is a flow chart of a zero-speed interval detection method with multiple condition constraints described in the present invention.
[0036] Figure 2 It is a zero-speed interval detection result diagram of a zero-speed interval detection method with multiple condition constraints described in the present invention. DETAILED DESCRIPTION
[0037] The present invention will be further described below in conjunction with the accompanying drawings and specific embodiments:
[0038] Figure 1 This is a flowchart of a multi-condition constrained zero-speed interval detection method described in the present invention. The raw data output by the three-axis gyroscope and the three-axis accelerometer must first be calibrated and low-pass filtered, and then a smaller threshold is used to fuzzy predict the zero-speed interval and the motion interval. The peak moment is determined by the circular comparison method in each motion interval. The gait cycle can be calculated using the two adjacent peak moments, and then the dynamic weighting method is used to predict the next gait cycle. Finally, the zero-speed interval is accurately located based on the proportional relationship between the gait cycle and the zero-speed interval. Specifically, the following steps are included:
[0039] S1: An inertial measurement unit is installed on the pedestrian's instep to collect the angular rate data of the three-axis gyroscope in real time. x ,ω y ,ω z and the acceleration data a of the triaxial accelerometer x 、a y 、a z , let the sampling time be i, and the startup static waiting time be T w , the data collected by the inertial measurement unit is processed as follows:
[0040] When i is less than or equal to T w When , the average vector sum Ω of the gyroscope output on the three orthogonal axes is calculated ave and the average vector sum A of the accelerometer outputs on the three orthogonal axes ave :
[0041]
[0042]
[0043] Among them, Ω(i) represents the vector sum of the gyroscope outputs on the three orthogonal axes at time i, Ω s晦m Indicates that the sampling time i is less than or equal to the static waiting time T w All Ω i The sum of the three orthogonal axes is represented by A(i), which is the vector sum of the accelerometer outputs on the three orthogonal axes at time i. s晦m Indicates that the sampling time i is less than or equal to the static waiting time T w All A i sum;
[0044] When i is greater than T w When the real-time vector sum of the three-axis gyroscope and the three-axis accelerometer is calculated, the average vector sum Ω ave , A ave Do the difference to get the calibrated vector sum result Ω correct , A correct , which is also the input for low-pass filtering.
[0045]
[0046] The vector sum Ω of the calibrated three-axis gyroscope and three-axis accelerometer correct , A correct Input low-pass filter for low-pass filtering:
[0047]
[0048] Where α is the filter coefficient, Ω lfc (i) is the vector sum of the gyroscope after filtering, A lfc (i) is the vector sum of the accelerometer after filtering.
[0049] S2: Set two smaller thresholds Ω zero , A zero , use this small threshold to make fuzzy predictions on the zero speed interval and the motion interval. lfc (i) Less than the set threshold Ω zero , and A lfc (i) Less than the set threshold A zeroWhen both conditions are met, it is judged that the moment is in the zero speed interval, otherwise it is in the motion interval.
[0050] S3: Use the cyclic comparison method to find the maximum value a of the vertical accelerometer in each predicted motion interval. ipeak and the corresponding sampling time Similarly, the sampling time of the peak acceleration in the previous predicted motion interval can be calculated and The difference is used to obtain the gait period T of the pedestrian movement. i-1 , and similarly trace back M-1 gait cycles; where M is the set value.
[0051] S4: Perform weighted calculation on M gait cycles to obtain the predicted value T of the current gait cycle p :
[0052]
[0053] Among them, K i represents the weight coefficient of the i-th gait cycle. The later the i is, the greater the K i The larger the value of T i-1 represents the gait cycle of the i-1 predicted motion interval, T i-M Indicates the gait cycle of the iM predicted motion interval.
[0054] S5: Based on the proportional relationship between the current gait cycle prediction value and the zero-speed interval, the zero-speed interval after accurate positioning is obtained with the peak acceleration sampling time as the starting point. The zero-speed interval T zero The calculation formula is as follows:
[0055]
[0056] Among them, P 1 is the ratio from heel contact to sole contact in a gait cycle, P 2 is the proportion of the zero-speed interval in a gait cycle, P 1 , P 2 It can be flexibly selected according to the statistical characteristics of pedestrian gait data. is the sampling time corresponding to the maximum value of the vertical accelerometer.
[0057] The beneficial effects of the present invention are further illustrated in conjunction with the following experiments. In the experiment, the inertial measurement unit is installed on the instep of a pedestrian, and the inertial measurement unit data is randomly collected for 1 minute during the pedestrian's walking process, and the P value representing the pedestrian's gait characteristics is calculated. 1 , P 2 The total walking distance in this experiment is about 250m, P 1 =0.2, P 2 =0.27. Figure 2 The recognition results of the zero-speed interval are given, and the correct recognition rate reaches 100%.
[0058] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions and improvements made within the principles of the present invention are within the protection scope of the present invention.
Claims
1. A zero-speed interval detection method with multiple condition constraints, using MEMS-IMU to collect pedestrian back foot motion information, characterized in that: The following steps are involved: S1: collect the angular velocity information of the three-axis gyroscope and the acceleration information of the three-axis accelerometer in real time, and calibrate and low-pass filter the collected information; S2: According to the angular velocity information and the acceleration information, the threshold Ω is set respectively zero and A zero The relationship between and is used to obtain the prediction results of the zero-speed interval and the motion interval; S3: According to the prediction result of the motion interval, the peak acceleration sampling time and the pedestrian gait cycle are obtained, and M-1 gait cycles are traced back; where M is a set value; S4: performing weighted calculation on the M gait cycles to obtain a predicted value of the current gait cycle; S5: according to the proportional relationship between the predicted value of the current gait cycle and the zero-speed interval, taking the peak acceleration sampling moment as the starting point, obtaining the zero-speed interval after precise positioning; The calibration in step S1 includes the following steps: Set the angular velocity information output when the three-axis gyroscope sampling time is i to ω x (i), ω y (i), ω z (i), the acceleration information measurement value output by the triaxial accelerometer at sampling time i is a x (i) a y (i) a z (i) The power-on standby waiting time is T w ; When the sampling time i is less than or equal to T w When , the average vector sum Ω of the gyroscope output on the three orthogonal axes is calculated ave and the average vector sum A of the accelerometer outputs on the three orthogonal axes ave : Among them, Ω(i) represents the vector sum of the gyroscope outputs on the three orthogonal axes at time i, Ω sum Indicates that the sampling time i is less than or equal to the static waiting time T w All Ω i The sum of the three orthogonal axes is represented by A(i), which is the vector sum of the accelerometer outputs on the three orthogonal axes at time i. sum Indicates that the sampling time i is less than or equal to the static waiting time T w When all A i sum; When the sampling time i is greater than T w When the real-time vector sum of the three-axis gyroscope and the three-axis accelerometer is calculated, the real-time vector sum of the three-axis gyroscope and the three-axis accelerometer is calculated and corresponds to the average vector sum Ω ave , A ave Do the difference to get the calibrated vector sum result Ω correct , A correct ; Wherein, the step S3 is specifically as follows: The maximum value of the vertical accelerometer and the corresponding sampling time are found by the circular comparison method in the predicted motion interval, and the sampling time of the peak acceleration in the first M-1 predicted motion intervals is calculated respectively, and the sampling time of two adjacent predicted motion intervals is subtracted to obtain M gait cycles; Wherein, the step S4 is specifically as follows: The weighted dynamic time constraints are applied to each of the M gait cycles to obtain the predicted value T of the current gait cycle. p ; Among them, K i represents the weight coefficient of the i-th gait cycle. The later the i is, the greater the K i The larger the value of T i-1 represents the gait cycle of the i-1 predicted motion interval, T i-M Indicates the gait cycle of the iM predicted motion interval.
2. The multi-condition constrained zero-speed interval detection method according to claim 1, characterized in that: The prediction method of the zero speed interval and the motion interval in step S2 is: When the real-time vector sum of the three-axis gyroscope after calibration and low-pass filtering is less than the set threshold Ω zero , and the real-time vector sum of the three-axis accelerometer after calibration and low-pass filtering is less than the set threshold A zero When both conditions are met, it is judged as a zero-speed interval, otherwise it is a motion interval.
3. The zero-speed interval detection method with multiple condition constraints according to claim 1, characterized in that: The zero speed interval T after accurate positioning in step S5 zero The calculation formula is as follows: Among them, P1 is the proportion from heel touchdown to sole touchdown in a gait cycle, P2 is the proportion of zero speed interval in a gait cycle, T p is the predicted value of the current gait cycle, is the sampling time corresponding to the maximum value of the vertical accelerometer.
Citation Information
Cited By
Gait analysis method based on combination of smart phone and inertial sensor
CN120052887A
