Disclosure of Invention
The invention aims to provide a zero-speed detection method with high accuracy and strong adaptability, so as to solve the problems that the traditional fixed threshold zero-speed detection algorithm is easy to cause misjudgment and missed judgment in a complex motion state and improve the precision of a pedestrian micro autonomous navigation system.
In order to solve the technical problem, the invention provides a self-adaptive zero-speed interval judgment method, which adopts the following technical scheme:
fixing a micro-inertia measurement unit on the foot of a pedestrian, collecting the acceleration and angular rate of the foot of a plurality of groups of pedestrians in different motion states, carrying out noise reduction processing on the acceleration and angular rate, and then carrying out statistics on the peak values of the acceleration in gait cycles at each zero-speed moment and non-zero-speed moment so as to extract the motion state characterization quantity;
constructing a training sample set based on the motion state characteristic quantity, the acceleration and the angular rate in each zero-speed moment and non-zero-speed moment gait cycle;
classifying the zero-velocity points and the non-zero-velocity points by adopting a support vector machine algorithm, and solving boundary conditions to obtain decision functions of the zero-velocity points and the non-zero-velocity points;
and adaptively adjusting the zero-speed detection threshold of the next period according to the peak value of the acceleration output by the micro-inertia measurement unit in the current gait period, and judging whether the current zero-speed state is the zero-speed state, thereby realizing the judgment of the zero-speed interval.
The method has the beneficial effects that the method adopts a support vector machine algorithm to classify the foot angular velocity and the acceleration of the pedestrian in the zero-velocity state and the non-zero-velocity state, adaptively adjusts the zero-velocity detection criterion, improves the zero-velocity detection accuracy and the adaptability to complex gait, and further improves the autonomous navigation precision of the pedestrian.
Detailed Description
It should be noted that the embodiments and features of the embodiments in the present application may be combined with each other without conflict. The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. The following description of at least one exemplary embodiment is merely illustrative in nature and is in no way intended to limit the invention, its application, or uses. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
As shown in fig. 1, the adaptive zero-speed interval determination method provided by the present invention is as follows:
fixing a micro-inertia measurement unit on the foot of a pedestrian, collecting the acceleration and angular rate of the foot of a plurality of groups of pedestrians in different motion states (including walking, running, jumping and the like), carrying out noise reduction treatment on the acceleration and angular rate, and then carrying out statistics on the peak values of the acceleration in gait cycles at each zero-speed moment and non-zero-speed moment to extract the motion state characterization quantity;
constructing a training sample set based on the motion state characteristic quantity, the acceleration and the angular rate in each zero-speed moment and non-zero-speed moment gait cycle;
classifying the zero-velocity point and the non-zero-velocity point by adopting a support vector machine algorithm, and solving a boundary condition, namely a functional relation between a zero-velocity detection threshold value and acceleration and angular rate peak values;
and the threshold value of the zero-speed detection of the next period is adaptively adjusted according to the peak value of the acceleration output by the micro-inertia measurement unit in the current gait period, and whether the current zero-speed state is the zero-speed state is judged, so that the judgment of a zero-speed interval is realized, the probability of erroneous judgment and missed judgment is reduced, and the accuracy and the adaptability of the zero-speed detection are improved.
In some embodiments of the present invention, the motion state characteristic amount extraction method includes:
(1) raw inertial data acquisition
The micro-inertia measurement unit is fixed on the foot of the pedestrian, and a plurality of groups of raw data of the angular velocity and the acceleration of the foot of the pedestrian under different motion states (including walking, running, jumping and the like) are collected.
(2) Motion state characterization quantity extraction
Calculating the vertical acceleration of the noise-reduced foot after deducting the gravity acceleration at the time t as follows:
At=at-g
wherein a istThe vertical acceleration is acquired at the moment t, and g is the local gravity acceleration. Setting a certain window, and finding A in the windowtPeak value of (a):
wherein T is
vIs the window width. Since the foot needs to move faster as the moving speed increases during walking, the peak value of the acceleration of the foot increases in the non-zero speed interval of the gait cycle. Thus can be used
The state of motion is characterized in that,
the larger the movement speed is.
In some embodiments of the present invention, the training sample set constructing method is as follows:
classifying and marking the collected foot angular rate and acceleration of the pedestrian under different motion states according to whether the foot angular rate and the acceleration are in a zero-speed state, and constructing a training sample set as follows:
wherein, ω is
tIs a model of the angular velocity of the foot of a pedestrian,
respectively is the standard deviation of the acceleration and the angular rate, and N is the sample capacity of the training set; z is a radical of
n0 or 1, z
n0 denotes a non-zero velocity state, z
n1 represents the zero speed state.
Further, a support vector machine algorithm is adopted for T
A、T
ω、
Classifying to obtain the boundary between zero-speed state and non-zero-speed state under different motion states, and determining the boundarySolving the expression, wherein the expression of the boundary condition is as follows:
wherein, phi ([ A ]p A]T)、Φ(Ap ω]T)、Φ(Ap σA]T)、Φ(Ap σω]T) Are respectively [ A ]p A]T、[Ap ω]T、[Ap σA]T、[Ap σω]TMapping to a high dimension.
Further, a decision function is constructed according to the boundary conditions
If A of the foot of the pedestrian at a certain moment
t、ω
t、
At the same time satisfy
The current state is considered as the zero speed state, otherwise, the state is the non-zero speed state.
The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention, and various modifications and changes may be made by those skilled in the art. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.