WO2023108498A1 - Zero-speed interval detection method, pedestrian navigation system and storage medium - Google Patents

Zero-speed interval detection method, pedestrian navigation system and storage medium Download PDF

Info

Publication number
WO2023108498A1
WO2023108498A1 PCT/CN2021/138455 CN2021138455W WO2023108498A1 WO 2023108498 A1 WO2023108498 A1 WO 2023108498A1 CN 2021138455 W CN2021138455 W CN 2021138455W WO 2023108498 A1 WO2023108498 A1 WO 2023108498A1
Authority
WO
WIPO (PCT)
Prior art keywords
zero
data
interval
speed interval
gyroscope
Prior art date
Application number
PCT/CN2021/138455
Other languages
French (fr)
Chinese (zh)
Inventor
孙方敏
周攀
李烨
Original Assignee
中国科学院深圳先进技术研究院
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 中国科学院深圳先进技术研究院 filed Critical 中国科学院深圳先进技术研究院
Priority to PCT/CN2021/138455 priority Critical patent/WO2023108498A1/en
Publication of WO2023108498A1 publication Critical patent/WO2023108498A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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/18Stabilised platforms, e.g. by gyroscope
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations

Definitions

  • the invention relates to the technical field of navigation, in particular to a detection method for a zero-speed interval, a pedestrian navigation system and a storage medium.
  • the satellite navigation systems represented by China's Beidou and the US GPS are very mature.
  • the satellite signal strength will be greatly attenuated in the occlusion environment, which cannot meet the positioning accuracy requirements or even realize the positioning function.
  • other types of positioning technologies have been proposed one after another, among which the representative positioning technologies based on WiFi, Bluetooth, infrared rays and inertial sensors.
  • the first three technologies all need to arrange a large number of signal transmitting/receiving devices in the environment in advance, and their equipment deployment and maintenance costs are proportional to the area of the working environment, and they cannot work in an environment without equipment deployment.
  • the signal is easily blocked or limited by the signal transmission distance; while the inertial sensor is carried by the user, is not restricted by the environment, and has a lower cost of use, so compared with the previous three technologies, the inertial sensor has more advantages .
  • the inertial sensor has a built-in accelerometer and gyroscope that can collect acceleration signals and angular velocity signals, and then integrate the signals to obtain position and direction information.
  • the calculated speed and position will be in a short time. Rapid divergence, resulting in low positioning accuracy.
  • the foot regularly touches the ground and remains stationary on the ground for short periods of time. This is the zero velocity zone. Resetting the speed to zero in the zero-speed interval can effectively suppress the divergence of speed and position caused by sensor noise. Correctly detecting the zero-speed interval and reducing the missed detection rate and false detection rate in the zero-speed interval are important means to improve positioning accuracy.
  • the current zero-speed detection methods based on inertial sensors mainly include two categories: (1) machine learning and (2) statistical methods.
  • Machine learning methods usually achieve zero-speed interval detection of test gait data through feature extraction, feature screening, and model training.
  • the statistical method usually substitutes the acceleration value and angular velocity value into a predefined formula to calculate the result, and detects the zero-speed interval by comparing the result with the custom threshold value.
  • the statistical method does not need to collect and mark a large amount of training data, the calculation amount is smaller, and a higher accuracy rate can be obtained under the condition of proper threshold optimization.
  • the invention improves the traditional statistical method to transform the threshold problem into the extreme value detection problem, effectively avoids the limitations of the traditional method, and uses the angular velocity signal collected by the inertial sensor fixed on the user's feet to adaptively determine the window size for each step , and finally realize the accurate extraction of the zero-speed interval of both feet.
  • the research on zero-speed interval detection can be divided into three main methods: machine vision-based, pressure sensor-based and inertial sensor-based zero-speed detection.
  • This method uses a high-speed camera to capture the user's walking process, and then uses an image processing algorithm to obtain the trajectory signal of the reflective point, and then uses this signal to detect the zero-speed interval.
  • the usability of this method is limited by occlusion, distance, and can only be used in environments where cameras are installed.
  • This method installs the pressure sensor on the sole of the foot. When the foot surface touches the ground to support the body, the output value of the pressure sensor reaches the maximum, which is the zero-speed zone. However, the performance of the pressure sensor is easily affected by the installation method and the external environment.
  • Inertial sensors are often used in positioning, motion monitoring, etc.
  • Machine vision and pressure sensors are usually used as the gold standard for the detection results of inertial sensors in the zero-speed interval to judge the latter’s missed detection and false detection rates.
  • the above-mentioned technical method has certain deficiencies in the simultaneous detection of zero speed of both feet, etc., which leads to high problems such as false detection in the zero speed interval.
  • the present invention aims to overcome the defective that prior art exists, and the present invention adopts following technical scheme:
  • the present invention provides a method for detecting a zero-speed interval, which is applied to a pedestrian navigation system.
  • the detection method comprises the steps of:
  • S1 data acquisition: use the gyroscope to collect data on the feet of pedestrians;
  • Interval Length Estimation Determine the interval length of each step through the gyroscope Z-axis data segmentation point interval, and then divide the initial zero-speed interval around the extreme point according to the length;
  • the step S2, determining the adaptive energy window and the scope of action is specifically: using the periodicity of the Z-axis data of the biped gyroscope to determine the angular velocity energy difference and determine the size of the window in the angular velocity energy difference detector AREDD and scope of action.
  • a step is further included: detecting the standing state.
  • the detection of the standing state in the step specifically includes: using the gyroscope data to calculate the Euclidean distance between the feet to divide the standing state and the walking state.
  • the standing state detection in the step further includes: the detected part of the data in the standing still state is judged to belong to the zero-speed interval, and the walking state is detected, and then step S2 is performed: determining the adaptive energy window and the working range.
  • the determining the angular velocity energy difference periodically using the Z-axis data of the biped gyroscope to determine the size of the window in the angular velocity energy difference detector AREDD further includes: performing a smoothing operation on the window value.
  • the gyroscope data is gyroscope Z-axis data.
  • the collected data includes: two-foot gait signals.
  • the present invention provides a pedestrian navigation system, including: a zero-speed interval detection device, a processor and a memory;
  • the zero-speed interval detection device is arranged on a pedestrian, and obtains a signal based on the motion state of the pedestrian; the memory stores computer instructions that can be read by the processor, and when the computer instructions are read , the processor executes and implements the method for detecting a zero-speed interval as described above.
  • the present invention provides a computer-readable storage medium, where a computer program is stored in the computer-readable storage medium, and when the computer program is executed by a processor, the above-mentioned zero-speed interval detection method is realized.
  • the zero-speed interval detection method disclosed in the present invention collects data on the feet of pedestrians through a gyroscope to determine the adaptive energy window value and range of action in the angular velocity energy difference detector AREDD, and according to the adaptive The energy window value is calculated separately by subtracting the ARED values of the left and right feet, and then the absolute value is taken. Finally, the interval length estimation and interval adjustment are performed to obtain the detection result of the zero-speed interval. It uses the angular velocity energy difference method of both feet to calculate the energy value of the angular velocity of both feet.
  • the absolute value of the difference transforms the threshold selection problem in the traditional zero-speed detection method into the extreme value detection problem, avoiding the limitation that the traditional threshold method is difficult to apply to different walking speeds, and effectively reducing the missed detection rate.
  • the present invention utilizes the regularity and correlation of both feet when walking to detect the zero-speed interval of the left and right feet simultaneously. The speed range effectively reduces the calculation amount.
  • Fig. 1 is the operation flowchart of the zero-speed zone detection method according to one embodiment of the present invention
  • Fig. 2 is the gyroscope data of three axes collected during pedestrian walking according to an embodiment of the present invention
  • Fig. 3 is part of Z-axis gyroscope data intercepted according to an embodiment of the present invention
  • Fig. 4 is the data when the pedestrian starts to move according to one embodiment of the present invention.
  • Fig. 5 is the data of pedestrians when they stop moving according to one embodiment of the present invention.
  • Fig. 6 is the data of pedestrians swinging their feet when they start exercising according to one embodiment of the present invention.
  • Fig. 7 is the data of pedestrians swinging their feet when they stop moving according to an embodiment of the present invention.
  • Figure 8 is an initial window value curve obtained from an experiment according to an embodiment of the present invention.
  • Fig. 9 is the size of the window value after smoothing the initial window value curve according to an embodiment of the present invention.
  • Fig. 10 is a schematic diagram of the minimum point on the AREDD curve according to an embodiment of the present invention.
  • Fig. 11 is a schematic diagram of a detection result of a minimum point according to an embodiment of the present invention.
  • Fig. 12 is a schematic diagram of an initial zero-speed interval and an adjusted zero-speed interval according to an embodiment of the present invention.
  • Figure 13 is a comparison chart of detection results according to an embodiment of the present invention.
  • Fig. 14 is a schematic flowchart of a method for detecting a zero-speed interval according to an embodiment of the present invention.
  • the present invention aims to overcome the defects in the prior art, and proposes a zero-speed interval detection method based on inertial sensors.
  • An inertial sensor is fixed at the heel of the left and right feet, and then the built-in accelerometer and gyroscope of the inertial sensor are used to collect data respectively.
  • the two-foot gait signal through steps such as standing state detection, angular velocity energy difference detector (AREDD), energy window adjustment, and interval adjustment, can accurately detect the zero-speed interval at different movement speeds.
  • AREDD angular velocity energy difference detector
  • the main technical content includes proposing a method for detecting the standing state based on the Euclidean distance between the feet, which can effectively detect the standing state (the standing state means that both feet are in the zero-speed range); based on the traditional angular velocity energy detector (ARED)
  • the Angular Velocity Energy Difference Detector (AREDD) is proposed, which effectively avoids the limitation that the ARED threshold needs to be continuously adjusted manually as the movement speed changes, and effectively reduces the missed detection rate; a dynamic adjustment of the AREDD window based on the Z-axis data of the gyroscope is proposed.
  • the length method makes the extreme point of the AREDD curve closer to the middle of the zero-speed interval, which effectively improves the detection accuracy; finally, a method of adjusting the length and range of the zero-speed interval is proposed to obtain the final zero-speed range, which effectively improves the detection accuracy.
  • the present invention provides a method for detecting a zero-speed interval, which is applied to a pedestrian navigation system.
  • the detection method comprises the steps of:
  • S1 data acquisition: use the gyroscope to collect data on the feet of pedestrians;
  • Interval Length Estimation Determine the interval length of each step through the gyroscope Z-axis data segmentation point interval, and then divide the initial zero-speed interval around the extreme point according to the length;
  • the step S2, determining the adaptive energy window and the scope of action is specifically: Using the periodicity of the biped gyroscope Z-axis data to determine the angular velocity energy difference and determine the size of the window in the angular velocity energy difference detector AREDD and scope of action.
  • a step is further included: detecting the standing state.
  • the detection of the standing state in the step specifically includes: using the gyroscope data to calculate the Euclidean distance between the feet to divide the standing state and the walking state.
  • the standing state detection in the step further includes: the detected part of the data in the standing still state is judged to belong to the zero-speed interval, and the walking state is detected, and then step S2 is performed: determining the adaptive energy window and the working range.
  • the determining the angular velocity energy difference periodically using the Z-axis data of the biped gyroscope to determine the size of the window in the angular velocity energy difference detector AREDD further includes: performing a smoothing operation on the window value.
  • the gyroscope data is gyroscope Z-axis data.
  • the collected data includes: two-foot gait signals.
  • Fig. 1 Shown in Fig. 1 with reference to, be the specific embodiment of the embodiment of the present invention, it mainly comprises following key steps:
  • Gyroscope data collection the collected data includes: two-foot gait signals.
  • Standing/exercise state detection Use gyroscope data to calculate the Euclidean distance between the feet to divide the standing and walking states.
  • Adaptive energy window and range of action use the periodicity of the Z-axis data of the bipedal gyroscope to determine the size of the window and range of action in AREDD.
  • Angular Velocity Energy Difference Detector On the basis of the traditional ARED, it is improved. According to the window value of the second step, the ARED values of the left and right feet are respectively calculated and subtracted to take the absolute value, thus turning the problem of finding a suitable threshold into an extreme value detection problem.
  • the limitation of ARED is that it needs to find different suitable thresholds for different speeds, and AREDD can effectively avoid this problem.
  • Interval length estimation and interval adjustment The minimum value point found in the third step usually falls in the middle of the zero-speed interval. Interval adjustment needs to find a suitable interval length, determine the initial zero-speed interval range and adjust according to the extreme point interval and other steps. The interval length of each step is determined by the gyroscope Z-axis data segmentation point interval, and then the initial zero-speed interval is divided around the extreme point according to the length. However, when the speed is relatively large or small, compared with the real zero-speed interval, the initial zero-speed interval is relatively backward or forward. This embodiment calculates that the Z-axis data of the gyroscope moves to the left and right within the initial zero-speed interval. After the average value of a sampling point, the initial zero-speed interval is moved to the side with a smaller average value.
  • Step 1 Standing state detection
  • AREDD angular velocity energy difference detector
  • w represents the gyroscope signal
  • i represents the i-th sampling point, representing the left foot
  • r represents the right foot. Then collect the signal in the standing state, and calculate the maximum Euclidean distance in the signal:
  • the motion state is divided by the formula (4), where 0 represents the standing still state, 1 represents the standing shock state (both feet are standing but there is still a slight vibration), 2 represents the walking state, Indicates that around the sampling point i
  • the Z-axis data of the gyroscope at a certain point in the interval of continuous points is greater than T 1 , and T 1 is a user-defined parameter.
  • the detected part of the data in the standing still state belongs to the zero-speed interval.
  • the standing and oscillating state does not need to be processed.
  • the walking state needs to further use AREDD to detect the zero-speed interval.
  • Step 2 Adaptive energy window and scope
  • the Z-axis data cycle is clear and distinct, the curve is smooth, and the zero-speed interval is more intuitive; and from attached drawing 3, it can be seen that the data parts of the left and right feet less than zero are regularly interlaced and the amplitude is relatively large, so this
  • the embodiment selects the Z-axis gyroscope data to determine the size and scope of the window, which mainly includes the following steps:
  • T 4 is a custom parameter
  • the window value corresponding to the data points between d i and d i+1 is set to W i .
  • Step 3 Angular Velocity Energy Difference Detector (AREDD)
  • AREDD only uses gyroscope data, and this part needs to further detect the walking state data divided in the first step.
  • ARED Angular Rate Energy Detector
  • Z k 0 indicates that point k belongs to the zero-speed interval
  • W is the window length
  • is a self-defined threshold.
  • the value of ⁇ is crucial to the zero-speed detection results. Too low a threshold will lead to missed detection in the zero-speed interval, while too high a threshold will lead to false detection, and the ⁇ varies greatly between different subjects or different motion speeds , and it can only detect the zero-speed zone of a single foot.
  • the AREDD proposed by the embodiment of the present invention is improved on the basis of the ARED, and can simultaneously detect the zero-speed interval of both feet.
  • abs means to take the absolute value, and Respectively represent the ARED of the left and right feet of point j, the formula is given by Equation 12, and the window size of all data points j between the split point d i to d i+1 is set to W i when calculating ARED.
  • Mi is the zero-speed interval of the left foot or the right foot.
  • a Mi corresponds to a Mini , assuming that Mini is the jth data point in all data, then it can be distinguished by the following formula (17):
  • the present invention provides a pedestrian navigation system, including: a zero-speed interval detection device, a processor and a memory;
  • the zero-speed interval detection device is arranged on a pedestrian, and obtains a signal based on the motion state of the pedestrian; the memory stores computer instructions that can be read by the processor, and when the computer instructions are read , the processor executes and implements the method for detecting a zero-speed interval as described above.
  • the present invention provides a computer-readable storage medium, where a computer program is stored in the computer-readable storage medium, and when the computer program is executed by a processor, the above-mentioned zero-speed interval detection method is implemented.
  • the so-called processor can be a central processing unit (Central Processing Unit, CPU), and the processor can also be other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), application specific integrated circuits (Application Specific Integrated Circuit, ASIC) ), off-the-shelf programmable gate array (Field-Programmable Gate Array, FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc.
  • a general-purpose processor may be a microprocessor, or the processor may be any conventional processor, or the like.
  • the storage may be an internal storage unit of the server, such as a hard disk or memory of the server.
  • the memory may also be an external storage device of the server in other embodiments, such as a plug-in hard disk equipped on the server, a smart memory card (Smart Media Card, SMC), a secure digital card (Secure Digital, SD), flash card (Flash Card), etc.
  • the storage may also include both an internal storage unit of the server and an external storage device.
  • the memory is used to store operating system, application program, boot loader (Boot Loader), data and other programs, such as the program code of the computer program.
  • the memory can also be used to temporarily store data that has been output or will be output.
  • the zero-speed interval detection method disclosed in the present invention collects data on the feet of pedestrians through a gyroscope to determine the adaptive energy window value and range of action in the angular velocity energy difference detector AREDD, and according to the adaptive The energy window value is calculated separately by subtracting the ARED values of the left and right feet, and then the absolute value is taken. Finally, the interval length estimation and interval adjustment are performed to obtain the detection result of the zero-speed interval. It uses the angular velocity energy difference method of both feet to calculate the energy value of the angular velocity of both feet.
  • the absolute value of the difference transforms the threshold selection problem in the traditional zero-speed detection method into the extreme value detection problem, avoiding the limitation that the traditional threshold method is difficult to apply to different walking speeds, and effectively reducing the missed detection rate.
  • the present invention utilizes the regularity and correlation of both feet when walking to detect the zero-speed interval of the left and right feet simultaneously.
  • the speed range effectively reduces the calculation amount.
  • the present invention only extracts information in the time domain of the signal, and does not involve the frequency domain, so the present invention can be used in the zero-speed interval detection of quasi-real-time gait data.
  • the embodiment of the present invention also provides test verification, and the verification process and preliminary test results are as follows.
  • the embodiment of the present invention collects inertial sensor and pressure sensor data at different motion speeds, wherein the inertial sensor uses Xsens Dot, and the pressure sensor uses the force sense technology insole pressure gauge RPPS-99, and the zero velocity phase detected by the pressure gauge is used as the gold Standard, to test and verify the proposed zero-speed detection method based on inertial sensor.
  • the data of a subject is collected, aged 25, healthy and without disease in the lower limbs.
  • an inertial sensor sampling rate 120HZ
  • a pressure gauge sampling rate 50HZ
  • the subjects changed the forward speed according to their own ideas. After each speed change, they needed to move at a constant speed for a period of time, moving forward in a straight line for 80 seconds, and repeated data collection 5 times in total. Since the sampling rates of the pressure gauge and the inertial sensor are inconsistent, the embodiment of the present invention performs an up-sampling operation on the collected pressure gauge data at 120 Hz. The following data and pictures are from one of the experiments. Since there are too many data points collected in each experiment, it is not convenient to display them all, so the data at the beginning and end are selected for display.
  • Adaptive window size and range estimation method firstly, it is necessary to detect the swing process of both feet. The principle is explained above. The detection results are shown in Figure 6 and Figure 7 (in order to show intuitively, the swing is multiplied by 200). Fig. 6 is the data when starting to move, and accompanying drawing 7 is the data when stopping to move, and the thick solid line is the swing detection result.
  • Attached Figure 8 is the initial window value curve obtained by the experiment. It can be seen that the curve will oscillate back and forth around a certain value. For example, although it is in a constant speed stage between steps 50 and 80, the window size changes back and forth around 55, so it is necessary to Further smoothing operations.
  • Attached Figure 9 is the smoothed window value size. It can be seen that the window value oscillation in the constant speed stage is suppressed, and the window size is more reasonable.
  • Two-foot angular velocity energy difference method mainly includes calculation of AREDD and minimum value detection.
  • the principle of the experiment is explained above, and the calculation results are as follows: From Figure 10, it can be seen that the AREDD curve has a clear minimum value point , the minimum points are all less than 200 and close to the middle of the support phase. Accompanying drawing 11 is the minimum point detection result.
  • Zero-speed interval length estimation and zero-speed interval range adjustment method Calculate the interval length and combine the minimum value points to determine the initial zero-speed interval, and then adjust the initial zero-speed interval range. The principle has been described in detail above. The initial zero-speed interval The interval and the adjusted zero-speed interval are shown in Figure 12:
  • the embodiment of the present invention uses the pressure gauge data as a gold standard to evaluate the detection effect.
  • the detection results of the embodiment of the present invention include the zero-speed interval of the left and right feet at the same time (the method for judging whether a certain interval belongs to the left foot or the right foot has been given in the foregoing description), and the two pressure gauges placed in the shoes provide the left or right foot respectively. Therefore, the number of zero-speed intervals of each pressure gauge should be reduced by half.
  • the comparison of the test results of the two is shown in Figure 13 (a section of data is intercepted for easy display). It can be seen from FIG. 13 that each zero-speed interval detected by the embodiment of the present invention falls within the gold standard range of the left foot or right foot pressure gauge, without missing detection, and has good accuracy.
  • the present invention reduces the false detection rate by proposing the energy difference method of the angular velocity of both feet, and improves the performance of the energy difference method through the method of adaptive window size and range estimation and the window oscillation suppression method .
  • the invention adopts the Euclidean distance of the angular velocity of both feet to divide the user state into a standing static state, a standing oscillating state and a moving state, and solves the problem that the energy difference method cannot handle the first two user states.
  • the invention determines the length L of the zero-speed interval based on the Z-axis gyroscope data of both feet, and determines the range of length L as the initial zero-speed interval with the extreme point as the center, and then adjusts the initial position of the interval by calculating the mean value, effectively reducing false detection Rate.
  • the zero-speed interval detection method and device disclosed in the embodiment of the present invention collect and identify the marker pattern on the target screen, then calculate through optical communication transmission, and use the positioning algorithm to analyze the picture to obtain the marker Image information, obtain the relative position information between the image acquisition device and the target screen to complete the positioning.
  • the positioning method and device of the present invention realize the positioning operation of a large-scale and high-precision pedestrian navigation system based on the optical communication between the target screen and the image acquisition module, and use the designed specific marker pattern to assist positioning, so that the positioning calculation does not depend on the image matching algorithm. As a result, the positioning accuracy is greatly improved, and the equipment cost is low, the influence of environmental factors on the ranging accuracy is reduced, and the positioning stability in industrial applications is improved.
  • the embodiments of the present invention use deep learning models and traditional image processing methods to complete the recognition of marker patterns, and solve the problem that markers cannot be recognized because the images of markers are too small at a long distance from the camera. Therefore, compared with other camera positioning technologies, this solution greatly improves the scope of camera positioning.
  • the embodiment of the present invention utilizes the screen optical communication mechanism to transmit the absolute position of the screen to the pedestrian navigation system, so that the range of positioning is greatly increased.
  • RAM random access memory
  • ROM read-only memory
  • EEPROM electrically programmable ROM
  • EEPROM electrically erasable programmable ROM
  • registers hard disk, removable disk, CD-ROM, or any other Any other known storage medium.

Abstract

A zero-speed interval detection method, a pedestrian navigation system and a computer-readable medium. The zero-speed interval detection method comprises the steps of: acquiring data; determining an adaptive energy window and an action range; determining parameters of an angular rate energy difference detector; estimating an interval length; and adjusting the interval. The zero-speed interval detection method can reduce a zero-speed interval false detection rate.

Description

一种零速区间检测方法、行人导航系统及存储介质A zero-speed interval detection method, pedestrian navigation system and storage medium 技术领域technical field
本发明涉及导航技术领域,特别涉及一种零速区间检测方法、行人导航系统及存储介质。The invention relates to the technical field of navigation, in particular to a detection method for a zero-speed interval, a pedestrian navigation system and a storage medium.
背景技术Background technique
近年来,随着人们生活水平的提高,基于位置的服务需求越来越高。以中国北斗、美国GPS为代表的卫星导航系统已十分成熟,然而,在遮挡环境中卫星信号强度会大幅度衰减,无法满足定位精度要求甚至无法实现定位功能。在此背景下,其他类型的定位技术被相继提出,其中代表性的有基于WiFi、蓝牙、红外线和惯性传感器的定位技术。前三种技术都需要事先在环境中大量布置信号发射/接收装置,其设备部署成本和维护成本与工作环境面积成正比,并且无法在未部署设备的环境中工作,另外在与布置在环境中的设备通信过程中信号易被遮挡或者受信号传输距离限制;而惯性传感器是用户携带在身上,不受环境限制,且使用成本更低,所以相比前三种技术,惯性传感器具有更多优势。In recent years, with the improvement of people's living standards, the demand for location-based services is getting higher and higher. The satellite navigation systems represented by China's Beidou and the US GPS are very mature. However, the satellite signal strength will be greatly attenuated in the occlusion environment, which cannot meet the positioning accuracy requirements or even realize the positioning function. In this context, other types of positioning technologies have been proposed one after another, among which the representative positioning technologies based on WiFi, Bluetooth, infrared rays and inertial sensors. The first three technologies all need to arrange a large number of signal transmitting/receiving devices in the environment in advance, and their equipment deployment and maintenance costs are proportional to the area of the working environment, and they cannot work in an environment without equipment deployment. In the process of device communication, the signal is easily blocked or limited by the signal transmission distance; while the inertial sensor is carried by the user, is not restricted by the environment, and has a lower cost of use, so compared with the previous three technologies, the inertial sensor has more advantages .
现如今,基于惯性传感器的行人导航技术已成为工业界和学术界的一个焦点。惯性传感器内置了加速度计和陀螺仪可以采集加速度信号和角速度信号,然后对信号进行积分可获得位置和方向信息,然而由于惯性传感器存在噪声和积分特性,计算出来的速度和位置会在短时间内快速发散,导致定位精度低下。正常步行脚面会定期接触地面并在地面上保持短时间静止,这就是零速区间。在零速区间内把速度重置为零可以有效抑制传感器噪声导致的速度和位置发散,正确检测零速区间、降低零速区间的漏检测率和误检测率是提高定位精度的重要手段。Today, inertial sensor-based pedestrian navigation technology has become a focus in both industry and academia. The inertial sensor has a built-in accelerometer and gyroscope that can collect acceleration signals and angular velocity signals, and then integrate the signals to obtain position and direction information. However, due to the noise and integral characteristics of the inertial sensor, the calculated speed and position will be in a short time. Rapid divergence, resulting in low positioning accuracy. During normal walking, the foot regularly touches the ground and remains stationary on the ground for short periods of time. This is the zero velocity zone. Resetting the speed to zero in the zero-speed interval can effectively suppress the divergence of speed and position caused by sensor noise. Correctly detecting the zero-speed interval and reducing the missed detection rate and false detection rate in the zero-speed interval are important means to improve positioning accuracy.
当前基于惯性传感器的零速检测方法主要包括两类:(1)机器学习和(2)统计量法。机器学习方法通常通过特征提取,特征筛选,模型训练,实现对测试步态数据的零速区间检测。统计量法通常把加速度值和角速度值代入预定义公式算出结果,通过比较结果与自定义阈值大小来检测零速区间。相较于机器学习方法,统计量法不需要大量收集并标记训练数据,计算量更小,在阈值优化得当的条件下也能获得较高的正确率。本发明改良传统的统计量法把阈值问题转变为极值检测问题,有效规避了传统方法的局限,并利用固定在用户双脚的惯性传感器采集到的角速度信号自适应地为每一步确定窗口大小,最后实现双脚零速区间的准确提取。The current zero-speed detection methods based on inertial sensors mainly include two categories: (1) machine learning and (2) statistical methods. Machine learning methods usually achieve zero-speed interval detection of test gait data through feature extraction, feature screening, and model training. The statistical method usually substitutes the acceleration value and angular velocity value into a predefined formula to calculate the result, and detects the zero-speed interval by comparing the result with the custom threshold value. Compared with the machine learning method, the statistical method does not need to collect and mark a large amount of training data, the calculation amount is smaller, and a higher accuracy rate can be obtained under the condition of proper threshold optimization. The invention improves the traditional statistical method to transform the threshold problem into the extreme value detection problem, effectively avoids the limitations of the traditional method, and uses the angular velocity signal collected by the inertial sensor fixed on the user's feet to adaptively determine the window size for each step , and finally realize the accurate extraction of the zero-speed interval of both feet.
零速区间检测的研究可分为三种主要方法:基于机器视觉,基于压力传感器和基于惯性传感器的零速检测。The research on zero-speed interval detection can be divided into three main methods: machine vision-based, pressure sensor-based and inertial sensor-based zero-speed detection.
基于机器视觉:这种方法使用高速摄像机捕捉用户走路过程,然后使用图像处理算法得到反光点的轨迹信号,然后利用该信号检测零速区间。该方法的可用性受到遮挡、距离限制,且只能在安装了摄像机的环境中使用。Based on machine vision: This method uses a high-speed camera to capture the user's walking process, and then uses an image processing algorithm to obtain the trajectory signal of the reflective point, and then uses this signal to detect the zero-speed interval. The usability of this method is limited by occlusion, distance, and can only be used in environments where cameras are installed.
基于压力传感器:这种方法把压力传感器安装在脚底,当脚面接触地面支撑身体时压力传感器输出值达到最大,此时即为零速区间。但压力传感器的性能很容易受到安装方式和外部环境的影响。Based on the pressure sensor: This method installs the pressure sensor on the sole of the foot. When the foot surface touches the ground to support the body, the output value of the pressure sensor reaches the maximum, which is the zero-speed zone. However, the performance of the pressure sensor is easily affected by the installation method and the external environment.
基于惯性传感器:惯性传感器常被应用在定位、运动监测等方面,机器视觉和压力传感器通常用于惯性传感器零速区间检测结果的金标准,用以判断后者漏检测和误检测率。Based on inertial sensors: Inertial sensors are often used in positioning, motion monitoring, etc. Machine vision and pressure sensors are usually used as the gold standard for the detection results of inertial sensors in the zero-speed interval to judge the latter’s missed detection and false detection rates.
上述技术方法在双脚零速同时检测等方面存在一定的不足,导致零速区间的误检测高等问题。The above-mentioned technical method has certain deficiencies in the simultaneous detection of zero speed of both feet, etc., which leads to high problems such as false detection in the zero speed interval.
发明内容Contents of the invention
本发明旨在克服现有技术存在的缺陷,本发明采用以下技术方案:The present invention aims to overcome the defective that prior art exists, and the present invention adopts following technical scheme:
第一方面,本发明提供了一种零速区间检测方法,应用于行人导航系统。所述检测方法包括步骤:In a first aspect, the present invention provides a method for detecting a zero-speed interval, which is applied to a pedestrian navigation system. The detection method comprises the steps of:
S1,数据采集:利用陀螺仪对行人的双脚进行数据采集;S1, data acquisition: use the gyroscope to collect data on the feet of pedestrians;
S2,确定自适应能量窗口和作用范围:通过所述采集的数据确定角速度能量差值探测器AREDD中自适应能量窗口值和作用范围;S2. Determine the adaptive energy window and the scope of action: determine the value of the adaptive energy window and the scope of action in the angular velocity energy difference detector AREDD through the collected data;
S3,角速度能量差值探测器参数确定:根据所述自适应能量窗口值分别计算左右脚ARED值相减后取绝对值,然后进行极小值点检测;S3, determining the parameters of the angular velocity energy difference detector: calculating the ARED values of the left and right feet respectively according to the adaptive energy window value, and then taking the absolute value, and then detecting the minimum value point;
S4,区间长度估计:通过陀螺仪Z轴数据分割点间隔确定每一步的区间长度,然后根据该长度在极值点周围划分出初始零速区间;S4, Interval Length Estimation: Determine the interval length of each step through the gyroscope Z-axis data segmentation point interval, and then divide the initial zero-speed interval around the extreme point according to the length;
S5,区间调整:计算陀螺仪Z轴数据在初始零速区间范围内、向左和向右移一个采样点的均值后,把初始零速区间移向均值较小的那一方,获得调整后的零速区间。S5, Interval adjustment: After calculating the mean value of the gyro Z-axis data within the initial zero-speed interval, moving one sampling point to the left and right, move the initial zero-speed interval to the side with a smaller average value, and obtain the adjusted Zero speed range.
在一些实施例中,所述步骤S2,确定自适应能量窗口和作用范围具体为:利用双脚陀螺仪Z轴数据的周期性确定角速度能量差值确定角速度能量差值探测器AREDD中窗口的大小和作用范围。In some embodiments, the step S2, determining the adaptive energy window and the scope of action is specifically: using the periodicity of the Z-axis data of the biped gyroscope to determine the angular velocity energy difference and determine the size of the window in the angular velocity energy difference detector AREDD and scope of action.
在一些实施例中,在所述步骤S1,数据采集后还包括步骤:站立状态检测。In some embodiments, after the data collection in the step S1, a step is further included: detecting the standing state.
在一些实施例中,在所述步骤站立状态检测具体为:利用陀螺仪数据计算双脚间的欧几里得距离来划分站立和行走状态。In some embodiments, the detection of the standing state in the step specifically includes: using the gyroscope data to calculate the Euclidean distance between the feet to divide the standing state and the walking state.
在一些实施例中,在所述步骤站立状态检测还包括:检测出的站立静止状态部分数据判断属于零速区间,检测出行走状态,则进行步骤S2:确定自适应能量窗口和作用范围。In some embodiments, the standing state detection in the step further includes: the detected part of the data in the standing still state is judged to belong to the zero-speed interval, and the walking state is detected, and then step S2 is performed: determining the adaptive energy window and the working range.
在一些实施例中,所述利用双脚陀螺仪Z轴数据的周期性确定角速度能量差值确定角速度能量差值探测器AREDD中窗口的大小时还包括:对窗口值进行平滑操作。In some embodiments, the determining the angular velocity energy difference periodically using the Z-axis data of the biped gyroscope to determine the size of the window in the angular velocity energy difference detector AREDD further includes: performing a smoothing operation on the window value.
在一些实施例中,所述陀螺仪数据为陀螺仪Z轴数据。In some embodiments, the gyroscope data is gyroscope Z-axis data.
在一些实施例中,所述采集的数据包括:双脚步态信号。In some embodiments, the collected data includes: two-foot gait signals.
第二方面,本发明提供了一种行人导航系统,包括:零速区间检测装置,处理器和存储器;In a second aspect, the present invention provides a pedestrian navigation system, including: a zero-speed interval detection device, a processor and a memory;
所述零速区间检测装置设于行人身上,并基于所述行人的运动状态获取信号;所述存储器,存储有能够被所述处理器读取的计算机指令,当所述计算机指令被读取时,所述处理器执行实现如前所述的零速区间检测方法。The zero-speed interval detection device is arranged on a pedestrian, and obtains a signal based on the motion state of the pedestrian; the memory stores computer instructions that can be read by the processor, and when the computer instructions are read , the processor executes and implements the method for detecting a zero-speed interval as described above.
第三方面,本发明提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现如前所述的零速区间检测方法。In a third aspect, the present invention provides a computer-readable storage medium, where a computer program is stored in the computer-readable storage medium, and when the computer program is executed by a processor, the above-mentioned zero-speed interval detection method is realized.
可以理解的是,上述第二方面和第三方面的有益效果可以参见上述第一方面的相关描述,在此不再赘述。It can be understood that, for the beneficial effects of the above-mentioned second aspect and the third aspect, reference may be made to the relevant description of the above-mentioned first aspect, and details are not repeated here.
本发明的技术效果:本发明公开的零速区间检测方法通过陀螺仪对行人的双脚进行数据采集确定角速度能量差值探测器AREDD中自适应能量窗口值和作用范围,并根据所述自适应能量窗口值分别计算左右脚ARED值相减后取绝对值,最后进行区间长度估计和区间调整获得零速区间的检测结果,其通过双脚角速度能量差值法,通过计算双脚角速度能量值之差的绝对值把传统零速检测方法中的阈值选取问题转化为极值检测问题,规避了传统阈值法难以适用于不同步行速度的局限,有效降低漏检率。且不同于现有技术中若要检测出两只脚的零速区间必须要为左右脚单独运行检测算法,而本发明利用步行时双脚的规律性和相关性,同时检测出左右脚的零速区间,有效降低了计算量。Technical effect of the present invention: the zero-speed interval detection method disclosed in the present invention collects data on the feet of pedestrians through a gyroscope to determine the adaptive energy window value and range of action in the angular velocity energy difference detector AREDD, and according to the adaptive The energy window value is calculated separately by subtracting the ARED values of the left and right feet, and then the absolute value is taken. Finally, the interval length estimation and interval adjustment are performed to obtain the detection result of the zero-speed interval. It uses the angular velocity energy difference method of both feet to calculate the energy value of the angular velocity of both feet. The absolute value of the difference transforms the threshold selection problem in the traditional zero-speed detection method into the extreme value detection problem, avoiding the limitation that the traditional threshold method is difficult to apply to different walking speeds, and effectively reducing the missed detection rate. And different from the prior art, if you want to detect the zero-speed range of two feet, you must run the detection algorithm separately for the left and right feet, but the present invention utilizes the regularity and correlation of both feet when walking to detect the zero-speed interval of the left and right feet simultaneously. The speed range effectively reduces the calculation amount.
附图说明Description of drawings
图1为根据本发明一个实施例的零速区间检测方法的运行流程图;Fig. 1 is the operation flowchart of the zero-speed zone detection method according to one embodiment of the present invention;
图2为根据本发明一个实施例的行人行走过程中采集到的三个轴的陀螺仪数据;Fig. 2 is the gyroscope data of three axes collected during pedestrian walking according to an embodiment of the present invention;
图3为根据本发明一个实施例的截取的部分双脚Z轴陀螺仪数据;Fig. 3 is part of Z-axis gyroscope data intercepted according to an embodiment of the present invention;
图4为根据本发明一个实施例的行人在开始运动时的数据;Fig. 4 is the data when the pedestrian starts to move according to one embodiment of the present invention;
图5为根据本发明一个实施例的行人在停止运动时的数据;Fig. 5 is the data of pedestrians when they stop moving according to one embodiment of the present invention;
图6为根据本发明一个实施例的行人在开始运动时双脚摆动的数据;Fig. 6 is the data of pedestrians swinging their feet when they start exercising according to one embodiment of the present invention;
图7根据本发明一个实施例的行人在停止运动时双脚摆动的数据;Fig. 7 is the data of pedestrians swinging their feet when they stop moving according to an embodiment of the present invention;
图8根据本发明一个实施例的实验求得的初始窗口值曲线;Figure 8 is an initial window value curve obtained from an experiment according to an embodiment of the present invention;
图9根据本发明一个实施例的初始窗口值曲线进行平滑操作后的窗口值大小;Fig. 9 is the size of the window value after smoothing the initial window value curve according to an embodiment of the present invention;
图10根据本发明一个实施例的AREDD曲线上极小值点的示意图;Fig. 10 is a schematic diagram of the minimum point on the AREDD curve according to an embodiment of the present invention;
图11根据本发明一个实施例的极小值点检测结果示意图;Fig. 11 is a schematic diagram of a detection result of a minimum point according to an embodiment of the present invention;
图12根据本发明一个实施例的初始零速区间和调整后的零速区间示意图;Fig. 12 is a schematic diagram of an initial zero-speed interval and an adjusted zero-speed interval according to an embodiment of the present invention;
图13根据本发明一个实施例的检测结果对照图;Figure 13 is a comparison chart of detection results according to an embodiment of the present invention;
图14为根据本发明一个实施例的零速区间检测方法的流程示意图。Fig. 14 is a schematic flowchart of a method for detecting a zero-speed interval according to an embodiment of the present invention.
具体实施方式Detailed ways
为了使本申请的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本申请进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本申请,并不用于限定本申请。In order to make the purpose, technical solution and advantages of the present application clearer, the present application will be further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described here are only used to explain the present application, not to limit the present application.
本发明旨在克服现有技术存在的缺陷,提出了一种基于惯性传感器的零速区间检测方法,在左右脚脚后跟处各固定一个惯性传感器,然后利用惯性传感 器内置的加速度计和陀螺仪分别采集双脚步态信号,通过站立状态检测、角速度能量差值探测器(AREDD)、能量窗口调整、区间调整等步骤实现不同运动速度下零速区间的准确检测。主要技术内容包括提出一种基于双脚欧几里得距离检测站立状态的方法,可有效检测出站立状态(站立状态即双脚都处于零速区间);基于传统的角速度能量探测器(ARED)提出了角速度能量差值探测器(AREDD),有效规避了ARED阈值随运动速度变化需要不断手动调整的局限,有效地降低了漏检率;提出了一种根据陀螺仪Z轴数据动态调整AREDD窗口长度的方法,使得AREDD曲线的极值点更接近零速区间的中部,有效地提高检测的准确性;最后,提出了一种调整零速区间长度和作用范围的方法,得出最终的零速区间,有效地提高了检测的准确率。The present invention aims to overcome the defects in the prior art, and proposes a zero-speed interval detection method based on inertial sensors. An inertial sensor is fixed at the heel of the left and right feet, and then the built-in accelerometer and gyroscope of the inertial sensor are used to collect data respectively. The two-foot gait signal, through steps such as standing state detection, angular velocity energy difference detector (AREDD), energy window adjustment, and interval adjustment, can accurately detect the zero-speed interval at different movement speeds. The main technical content includes proposing a method for detecting the standing state based on the Euclidean distance between the feet, which can effectively detect the standing state (the standing state means that both feet are in the zero-speed range); based on the traditional angular velocity energy detector (ARED) The Angular Velocity Energy Difference Detector (AREDD) is proposed, which effectively avoids the limitation that the ARED threshold needs to be continuously adjusted manually as the movement speed changes, and effectively reduces the missed detection rate; a dynamic adjustment of the AREDD window based on the Z-axis data of the gyroscope is proposed. The length method makes the extreme point of the AREDD curve closer to the middle of the zero-speed interval, which effectively improves the detection accuracy; finally, a method of adjusting the length and range of the zero-speed interval is proposed to obtain the final zero-speed range, which effectively improves the detection accuracy.
参考图14所示,第一方面,本发明提供了一种零速区间检测方法,应用于行人导航系统。所述检测方法包括步骤:Referring to FIG. 14 , in a first aspect, the present invention provides a method for detecting a zero-speed interval, which is applied to a pedestrian navigation system. The detection method comprises the steps of:
S1,数据采集:利用陀螺仪对行人的双脚进行数据采集;S1, data acquisition: use the gyroscope to collect data on the feet of pedestrians;
S2,确定自适应能量窗口和作用范围:通过所述采集的数据确定角速度能量差值探测器AREDD中自适应能量窗口值和作用范围;S2. Determine the adaptive energy window and the scope of action: determine the value of the adaptive energy window and the scope of action in the angular velocity energy difference detector AREDD through the collected data;
S3,角速度能量差值探测器参数确定:根据所述自适应能量窗口值分别计算左右脚ARED值相减后取绝对值,然后进行极小值点检测;S3, determining the parameters of the angular velocity energy difference detector: calculating the ARED values of the left and right feet respectively according to the adaptive energy window value, and then taking the absolute value, and then detecting the minimum value point;
S4,区间长度估计:通过陀螺仪Z轴数据分割点间隔确定每一步的区间长度,然后根据该长度在极值点周围划分出初始零速区间;S4, Interval Length Estimation: Determine the interval length of each step through the gyroscope Z-axis data segmentation point interval, and then divide the initial zero-speed interval around the extreme point according to the length;
S5,区间调整:计算陀螺仪Z轴数据在初始零速区间范围内、向左和向右移一个采样点的均值后,把初始零速区间移向均值较小的那一方,获得调整后的零速区间。S5, Interval adjustment: After calculating the mean value of the gyro Z-axis data within the initial zero-speed interval, moving one sampling point to the left and right, move the initial zero-speed interval to the side with a smaller average value, and obtain the adjusted Zero speed range.
在一些实施例中,所述步骤S2,确定自适应能量窗口和作用范围具体为: 利用双脚陀螺仪Z轴数据的周期性确定角速度能量差值确定角速度能量差值探测器AREDD中窗口的大小和作用范围。In some embodiments, the step S2, determining the adaptive energy window and the scope of action is specifically: Using the periodicity of the biped gyroscope Z-axis data to determine the angular velocity energy difference and determine the size of the window in the angular velocity energy difference detector AREDD and scope of action.
在一些实施例中,在所述步骤S1,数据采集后还包括步骤:站立状态检测。In some embodiments, after the data collection in the step S1, a step is further included: detecting the standing state.
在一些实施例中,在所述步骤站立状态检测具体为:利用陀螺仪数据计算双脚间的欧几里得距离来划分站立和行走状态。In some embodiments, the detection of the standing state in the step specifically includes: using the gyroscope data to calculate the Euclidean distance between the feet to divide the standing state and the walking state.
在一些实施例中,在所述步骤站立状态检测还包括:检测出的站立静止状态部分数据判断属于零速区间,检测出行走状态,则进行步骤S2:确定自适应能量窗口和作用范围。In some embodiments, the standing state detection in the step further includes: the detected part of the data in the standing still state is judged to belong to the zero-speed interval, and the walking state is detected, and then step S2 is performed: determining the adaptive energy window and the working range.
在一些实施例中,所述利用双脚陀螺仪Z轴数据的周期性确定角速度能量差值确定角速度能量差值探测器AREDD中窗口的大小时还包括:对窗口值进行平滑操作。In some embodiments, the determining the angular velocity energy difference periodically using the Z-axis data of the biped gyroscope to determine the size of the window in the angular velocity energy difference detector AREDD further includes: performing a smoothing operation on the window value.
在一些实施例中,所述陀螺仪数据为陀螺仪Z轴数据。In some embodiments, the gyroscope data is gyroscope Z-axis data.
在一些实施例中,所述采集的数据包括:双脚步态信号。In some embodiments, the collected data includes: two-foot gait signals.
参考图1所示,为本发明实施例的具体实施例,其主要包括以下几个关键步骤:Shown in Fig. 1 with reference to, be the specific embodiment of the embodiment of the present invention, it mainly comprises following key steps:
1、陀螺仪数据采集:所述采集的数据包括:双脚步态信号。1. Gyroscope data collection: the collected data includes: two-foot gait signals.
2、站立/运动状态检测:利用陀螺仪数据计算双脚间的欧几里得距离来划分站立和行走状态。2. Standing/exercise state detection: Use gyroscope data to calculate the Euclidean distance between the feet to divide the standing and walking states.
3、自适应能量窗口和作用范围:利用双脚陀螺仪Z轴数据的周期性确定AREDD中窗口的大小和作用范围。3. Adaptive energy window and range of action: use the periodicity of the Z-axis data of the bipedal gyroscope to determine the size of the window and range of action in AREDD.
4、角速度能量差值探测器(AREDD):在传统的ARED基础上进行改进,根据第二步的窗口值分别计算左右脚ARED值相减后取绝对值,从而把寻找合适阈值问题转变为极值检测问题。ARED的局限在于需要对不同速度找到不 同的合适的阈值,AREDD可以有效规避这个问题。4. Angular Velocity Energy Difference Detector (AREDD): On the basis of the traditional ARED, it is improved. According to the window value of the second step, the ARED values of the left and right feet are respectively calculated and subtracted to take the absolute value, thus turning the problem of finding a suitable threshold into an extreme value detection problem. The limitation of ARED is that it needs to find different suitable thresholds for different speeds, and AREDD can effectively avoid this problem.
5、区间长度估计及区间调整:通过第三步找到的极小值点通常落入零速区间的中部范围,区间调整需要找到合适的区间长度、根据极值点确定初始零速区间范围和调整区间等步骤。通过陀螺仪Z轴数据分割点间隔确定每一步的区间长度,然后根据该长度在极值点周围划分出初始零速区间。然而当速度比较大或小时,相比真实的零速区间,初始零速区间相对靠后或靠前,本实施例计算陀螺仪Z轴数据在初始零速区间范围内、向左和向右移一个采样点的均值后,把初始零速区间移向均值较小的那一方。5. Interval length estimation and interval adjustment: The minimum value point found in the third step usually falls in the middle of the zero-speed interval. Interval adjustment needs to find a suitable interval length, determine the initial zero-speed interval range and adjust according to the extreme point interval and other steps. The interval length of each step is determined by the gyroscope Z-axis data segmentation point interval, and then the initial zero-speed interval is divided around the extreme point according to the length. However, when the speed is relatively large or small, compared with the real zero-speed interval, the initial zero-speed interval is relatively backward or forward. This embodiment calculates that the Z-axis data of the gyroscope moves to the left and right within the initial zero-speed interval. After the average value of a sampling point, the initial zero-speed interval is moved to the side with a smaller average value.
以上关键步骤的详细描述如下:The detailed description of the above key steps is as follows:
第一步:站立状态检测Step 1: Standing state detection
因角速度能量差值探测器AREDD并不适用于站立状态部分的数据,所以需要先区分出站立状态和行走状态,公式如下所示:Because the angular velocity energy difference detector AREDD is not applicable to the data in the standing state, it is necessary to distinguish between the standing state and the walking state. The formula is as follows:
Figure PCTCN2021138455-appb-000001
Figure PCTCN2021138455-appb-000001
Figure PCTCN2021138455-appb-000002
Figure PCTCN2021138455-appb-000002
其中w表示陀螺仪信号,i表示第i个采样点,表示左脚,r表示右脚。然后采集站立状态下的信号,计算得到该信号中最大的欧几里得距离:Among them, w represents the gyroscope signal, i represents the i-th sampling point, representing the left foot, and r represents the right foot. Then collect the signal in the standing state, and calculate the maximum Euclidean distance in the signal:
Figure PCTCN2021138455-appb-000003
Figure PCTCN2021138455-appb-000003
然后通过公式(4)划分运动状态,其中0代表站立静止状态,1代表站立震荡状态(双脚站立但仍有细微的震动),2代表行走状态,
Figure PCTCN2021138455-appb-000004
表示采样点i周围
Figure PCTCN2021138455-appb-000005
连续点的区间内存在某点的陀螺仪Z轴数据大于T 1,T 1是自定义参数。
Then the motion state is divided by the formula (4), where 0 represents the standing still state, 1 represents the standing shock state (both feet are standing but there is still a slight vibration), 2 represents the walking state,
Figure PCTCN2021138455-appb-000004
Indicates that around the sampling point i
Figure PCTCN2021138455-appb-000005
The Z-axis data of the gyroscope at a certain point in the interval of continuous points is greater than T 1 , and T 1 is a user-defined parameter.
Figure PCTCN2021138455-appb-000006
Figure PCTCN2021138455-appb-000006
检测出的站立静止状态部分数据就属于零速区间,站立震荡状态不必再处理,行走状态需要进一步使用AREDD检测零速区间。The detected part of the data in the standing still state belongs to the zero-speed interval. The standing and oscillating state does not need to be processed. The walking state needs to further use AREDD to detect the zero-speed interval.
第二步:自适应能量窗口和作用范围Step 2: Adaptive energy window and scope
附图2是人行走过程中采集到的三个轴的陀螺仪数据,附图3是截取的部分双脚Z轴陀螺仪数据。Accompanying drawing 2 is the gyroscope data of three axes collected during people's walking, and accompanying drawing 3 is the Z-axis gyroscope data of part of two feet intercepted.
由附图2可以看到Z轴数据周期清晰分明、曲线光滑、零速区间更直观;并且由附图3可以看到左右脚小于零的数据部分有规律地相互交错并且幅度比较大,所以本实施例选择Z轴陀螺仪数据来确定窗口的大小和作用范围,主要包含以下几步:From attached drawing 2, it can be seen that the Z-axis data cycle is clear and distinct, the curve is smooth, and the zero-speed interval is more intuitive; and from attached drawing 3, it can be seen that the data parts of the left and right feet less than zero are regularly interlaced and the amplitude is relatively large, so this The embodiment selects the Z-axis gyroscope data to determine the size and scope of the window, which mainly includes the following steps:
1、摆动检测1. Swing detection
检测双脚Z轴陀螺仪数据ω z小于自定义阈值T的数据点,这些数据点组成幅值为1的数据段;然后左右脚的s合并起来组成swing,公式如下所示,其中T 1与第一步中的参数T 1相等。 Detect the data points where the Z-axis gyroscope data ω z of both feet is less than the custom threshold T. These data points form a data segment with an amplitude of 1; then the s of the left and right feet are combined to form a swing. The formula is as follows, where T 1 and The parameters T 1 in the first step are equal.
Figure PCTCN2021138455-appb-000007
Figure PCTCN2021138455-appb-000007
swing=-(s l+s r)          (6) swing=-(s l +s r ) (6)
2、确定窗口长度2. Determine the window length
因为本方法后续需要计算E k(公式12),而其公式中窗口值W是一个重要参数。经过实验发现,不同步态周期长度对应的最合适的W值不同,并且最好的W值是摆动相中点附近到下一个支撑相中点附近的长度(近似半个步态周期长度)。检测方法主要围绕上一步求出的swing展开,把swing中不为 零的连续数据点组成的数据段记为f i,i=1…k。 Because this method subsequently needs to calculate E k (formula 12), and the window value W in the formula is an important parameter. It is found through experiments that the most suitable W values corresponding to different gait cycle lengths are different, and the best W value is the length from near the midpoint of the swing phase to the midpoint of the next support phase (approximately half the gait cycle length). The detection method is mainly developed around the swing obtained in the previous step, and the data segment composed of non-zero continuous data points in the swing is recorded as f i , i=1...k.
分别找到每个数据段f的三分之一和三分之二的点,记为l和h:Find the points of one-third and two-thirds of each data segment f respectively, denoted as l and h:
Figure PCTCN2021138455-appb-000008
Figure PCTCN2021138455-appb-000008
Figure PCTCN2021138455-appb-000009
Figure PCTCN2021138455-appb-000009
其中floor表示向下取整,ceil表示向上取整,len表示数据段长度,startPoint表示数据段的初始点,endPoint表示数据段的结束点,T 2和T 3是自定义参数,那么窗口W值可由下面公式(9)确定: Where floor means rounding down, ceil means rounding up, len means the length of the data segment, startPoint means the initial point of the data segment, endPoint means the end point of the data segment, T 2 and T 3 are custom parameters, then the window W value It can be determined by the following formula (9):
W i=l i-h i           (9) W i = l i -h i (9)
当受试者匀速前进时,W值会在某一范围内来回震荡,需进一步做平滑操作,平滑方法如公式(10)所示:When the subject moves forward at a constant speed, the W value will oscillate back and forth within a certain range, and further smoothing operations are required. The smoothing method is shown in formula (10):
Figure PCTCN2021138455-appb-000010
Figure PCTCN2021138455-appb-000010
3、确定窗口W i作用区间 3. Determine the window W i action range
计算出W值后,还需要确定哪些数据点在计算AREDD时窗口值设置为W i。经实验发现,以双脚同时支撑身体时的某一时间点切换W i为W i+1时效果最好,记f i与f i+1之间值为0的连续数据点组成的数据段记为D i,然后计算D i的中点作为分割点d,如下公式(11)所示: After the W value is calculated, it is also necessary to determine which data points are set as the window value W i when calculating AREDD. It is found through experiments that switching W i to W i+1 at a certain point in time when both feet support the body at the same time works best, and record the data segment consisting of continuous data points with a value of 0 between f i and f i+1 Denote it as D i , and then calculate the midpoint of D i as the split point d, as shown in the following formula (11):
Figure PCTCN2021138455-appb-000011
Figure PCTCN2021138455-appb-000011
其中T 4是自定义参数,d i到d i+1之间的数据点对应的窗口值设置为W iWhere T 4 is a custom parameter, and the window value corresponding to the data points between d i and d i+1 is set to W i .
第三步:角速度能量差值探测器(AREDD)Step 3: Angular Velocity Energy Difference Detector (AREDD)
AREDD只使用陀螺仪数据,此部分需要对第一步划分出的行走状态数据进行进一步检测。ARED(Angular Rate Energy Detector)是传统的零速检测方法,其基本计算公式如(12)所示:AREDD only uses gyroscope data, and this part needs to further detect the walking state data divided in the first step. ARED (Angular Rate Energy Detector) is a traditional zero-speed detection method, and its basic calculation formula is shown in (12):
Figure PCTCN2021138455-appb-000012
Figure PCTCN2021138455-appb-000012
Figure PCTCN2021138455-appb-000013
Figure PCTCN2021138455-appb-000013
Z k=0表示k点属于零速区间,W是窗口长度,γ是自定义的阈值。γ的取值对零速检测结果至关重要,太低的阈值会导致零速区间漏检测,而太高的阈值会导致误检测,且不同受试者或不同运动速度下的γ差异很大,另外它只能检测单只脚的零速区间。本发明实施例提出的AREDD在ARED的基础之上改进,可以同时检测出双脚零速区间。 Z k =0 indicates that point k belongs to the zero-speed interval, W is the window length, and γ is a self-defined threshold. The value of γ is crucial to the zero-speed detection results. Too low a threshold will lead to missed detection in the zero-speed interval, while too high a threshold will lead to false detection, and the γ varies greatly between different subjects or different motion speeds , and it can only detect the zero-speed zone of a single foot. The AREDD proposed by the embodiment of the present invention is improved on the basis of the ARED, and can simultaneously detect the zero-speed interval of both feet.
1、计算AREDD1. Calculate AREDD
AREDD计算公式如下所示:The calculation formula of AREDD is as follows:
Figure PCTCN2021138455-appb-000014
Figure PCTCN2021138455-appb-000014
abs表示取绝对值,
Figure PCTCN2021138455-appb-000015
Figure PCTCN2021138455-appb-000016
分别表示j点左右脚的ARED,其公式已式12给出,分割点d i到d i+1间的所有数据点j在计算ARED时窗口大小都设为W i
abs means to take the absolute value,
Figure PCTCN2021138455-appb-000015
and
Figure PCTCN2021138455-appb-000016
Respectively represent the ARED of the left and right feet of point j, the formula is given by Equation 12, and the window size of all data points j between the split point d i to d i+1 is set to W i when calculating ARED.
2、极小值点检测2. Minimum point detection
本实施例遍历ED值组成的AREDD曲线,取任意一值小于200的样本点,让它跟左右相邻的样本点比较大小,若该样本点取值比左右的都小,本实施例认为该样本点为极小值点,记极小值点为Min i,i=1…k。 This embodiment traverses the AREDD curve composed of ED values, takes any sample point with a value less than 200, and compares it with the left and right adjacent sample points. If the value of the sample point is smaller than the left and right, this embodiment considers that The sample point is the minimum value point, and the minimum value point is recorded as Min i , i=1...k.
第四步、区间长度估计及区间调整The fourth step, interval length estimation and interval adjustment
初始零速区间长度L取值公式(15)如下:The value formula (15) of the initial zero-speed interval length L is as follows:
Figure PCTCN2021138455-appb-000017
Figure PCTCN2021138455-appb-000017
计算区间长度L i之后,就以极小值点Min i为中心,把区间M i当作第i个初始零速区间,M i的公式(16)如下: After calculating the interval length L i , take the minimum value point Mini as the center, and regard the interval Mi as the i-th initial zero-speed interval. The formula (16) of Mi is as follows:
Figure PCTCN2021138455-appb-000018
Figure PCTCN2021138455-appb-000018
然而,当速度过大/过小时,W i取值会偏大/偏小,导致极小值点靠后/靠前,从而使得M i覆盖了脚面在地面翻滚时产生的数据(并非零速),所以还需进一步调整M iHowever, when the speed is too large/too small, the value of W i will be too large/small, resulting in the minimum point behind/front, so that Mi covers the data generated when the foot rolls on the ground (not zero speed ), so M i needs to be further adjusted.
首先,先区分M i是左脚还是右脚的零速区间。一个M i对应一个Min i,假设Min i在所有数据中是第j个数据点,那么可以通过如下公式(17)区分: First of all, first distinguish whether Mi is the zero-speed interval of the left foot or the right foot. A Mi corresponds to a Mini , assuming that Mini is the jth data point in all data, then it can be distinguished by the following formula (17):
Figure PCTCN2021138455-appb-000019
Figure PCTCN2021138455-appb-000019
Belong(M i)=0表示M i是左脚的初始零速区间,反之是右脚。假设某一M i属于左脚,那么根据左脚陀螺仪Z轴数据
Figure PCTCN2021138455-appb-000020
来调整初始零速区间,算法如下:
Belong(M i )=0 means that M i is the initial zero-speed interval of the left foot, otherwise it is the right foot. Assuming that a certain M i belongs to the left foot, then according to the Z-axis data of the left foot gyroscope
Figure PCTCN2021138455-appb-000020
To adjust the initial zero-speed range, the algorithm is as follows:
1、计算
Figure PCTCN2021138455-appb-000021
在M i-1、M i和M i+1(注意并非是M i-1和M i+1)范围内的均值分别为A、B和C,如果C<B,跳到第2步;如果A<B,跳到第3步;如果B<A且B<C;跳到第4步;
1. Calculate
Figure PCTCN2021138455-appb-000021
The mean values in the range of Mi -1 , Mi and Mi +1 (not Mi -1 and Mi +1 ) are A, B and C respectively, if C<B, skip to step 2; If A<B, skip to step 3; if B<A and B<C; skip to step 4;
2、M i整体向右移动一个数据点,即M i=M i+1,跳到第1步; 2. Mi moves one data point to the right as a whole, that is, Mi = Mi + 1, and skips to step 1;
3、M i整体向左移动一个数据点,即M i=M i-1,跳到第1步; 3. Mi moves one data point to the left as a whole, that is, Mi = Mi -1, skip to step 1;
4、算法结束;4. The algorithm ends;
第二方面,本发明提供了一种行人导航系统,包括:零速区间检测装置,处理器和存储器;In a second aspect, the present invention provides a pedestrian navigation system, including: a zero-speed interval detection device, a processor and a memory;
所述零速区间检测装置设于行人身上,并基于所述行人的运动状态获取信号;所述存储器,存储有能够被所述处理器读取的计算机指令,当所述计算机指令被读取时,所述处理器执行实现如前所述的零速区间检测方法。The zero-speed interval detection device is arranged on a pedestrian, and obtains a signal based on the motion state of the pedestrian; the memory stores computer instructions that can be read by the processor, and when the computer instructions are read , the processor executes and implements the method for detecting a zero-speed interval as described above.
第三方面,本发明提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现如前所述的零速区间检测方法。In a third aspect, the present invention provides a computer-readable storage medium, where a computer program is stored in the computer-readable storage medium, and when the computer program is executed by a processor, the above-mentioned zero-speed interval detection method is implemented.
所称处理器可以是中央处理单元(Central Processing Unit,CPU),该处理器还可以是其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现成可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。The so-called processor can be a central processing unit (Central Processing Unit, CPU), and the processor can also be other general-purpose processors, digital signal processors (Digital Signal Processor, DSP), application specific integrated circuits (Application Specific Integrated Circuit, ASIC) ), off-the-shelf programmable gate array (Field-Programmable Gate Array, FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor, or the processor may be any conventional processor, or the like.
所述存储器在一些实施例中可以是所述服务器的内部存储单元,例如服务器的硬盘或内存。所述存储器在另一些实施例中也可以是所述服务器的外部存储设备,例如所述服务器上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字卡(Secure Digital,SD),闪存卡(Flash Card)等。进一步地,所述存储器还可以既包括所述服务器的内部存储单元也包括外部存储设备。所述存储器用于存储操作系统、应用程序、引导装载程序(Boot Loader)、数据以及其他程序等,例如所述计算机程序的程序代码等。所述存储器还可以用于暂时地存储已经输出或者将要输出的数据。In some embodiments, the storage may be an internal storage unit of the server, such as a hard disk or memory of the server. The memory may also be an external storage device of the server in other embodiments, such as a plug-in hard disk equipped on the server, a smart memory card (Smart Media Card, SMC), a secure digital card (Secure Digital, SD), flash card (Flash Card), etc. Further, the storage may also include both an internal storage unit of the server and an external storage device. The memory is used to store operating system, application program, boot loader (Boot Loader), data and other programs, such as the program code of the computer program. The memory can also be used to temporarily store data that has been output or will be output.
可以理解的是,上述第二方面和第三方面的有益效果可以参见上述第一方 面的相关描述,在此不再赘述。It can be understood that, for the beneficial effects of the above-mentioned second aspect and the third aspect, reference can be made to the relevant description of the above-mentioned first aspect, and details are not repeated here.
本发明的技术效果:本发明公开的零速区间检测方法通过陀螺仪对行人的双脚进行数据采集确定角速度能量差值探测器AREDD中自适应能量窗口值和作用范围,并根据所述自适应能量窗口值分别计算左右脚ARED值相减后取绝对值,最后进行区间长度估计和区间调整获得零速区间的检测结果,其通过双脚角速度能量差值法,通过计算双脚角速度能量值之差的绝对值把传统零速检测方法中的阈值选取问题转化为极值检测问题,规避了传统阈值法难以适用于不同步行速度的局限,有效降低漏检率。且不同于现有技术中若要检测出两只脚的零速区间必须要为左右脚单独运行检测算法,而本发明利用步行时双脚的规律性和相关性,同时检测出左右脚的零速区间,有效降低了计算量。本发明只在信号的时域上提取信息,不涉及频域,故本发明可以用在准实时步态数据的零速区间检测上。Technical effect of the present invention: the zero-speed interval detection method disclosed in the present invention collects data on the feet of pedestrians through a gyroscope to determine the adaptive energy window value and range of action in the angular velocity energy difference detector AREDD, and according to the adaptive The energy window value is calculated separately by subtracting the ARED values of the left and right feet, and then the absolute value is taken. Finally, the interval length estimation and interval adjustment are performed to obtain the detection result of the zero-speed interval. It uses the angular velocity energy difference method of both feet to calculate the energy value of the angular velocity of both feet. The absolute value of the difference transforms the threshold selection problem in the traditional zero-speed detection method into the extreme value detection problem, avoiding the limitation that the traditional threshold method is difficult to apply to different walking speeds, and effectively reducing the missed detection rate. And different from the prior art, if you want to detect the zero-speed range of two feet, you must run the detection algorithm separately for the left and right feet, but the present invention utilizes the regularity and correlation of both feet when walking to detect the zero-speed interval of the left and right feet simultaneously. The speed range effectively reduces the calculation amount. The present invention only extracts information in the time domain of the signal, and does not involve the frequency domain, so the present invention can be used in the zero-speed interval detection of quasi-real-time gait data.
为证明本发明的效果,本发明实施例还提供了试验验证,验证过程和初步试验结果如下所述。In order to prove the effect of the present invention, the embodiment of the present invention also provides test verification, and the verification process and preliminary test results are as follows.
本发明实施例采集了不同运动速度下的惯性传感器和压力传感器数据,其中,惯性传感器使用Xsens Dot,压力传感器使用力感科技鞋垫压力计RPPS-99,以压力计检测到的零速相作为金标准,对所提基于惯性传感器零速检测方法进行测试验证。本发明实施例采集了一名受试者的数据,年龄25岁,身体健康下肢无疾病。实验前在受试者双脚脚踝鞋面外侧各固定一个惯性传感器(采样率为120HZ),同时在两只鞋子里垫上压力计(采样率50HZ)。实验时受试者按照自己的想法改变前进速度,每次变速后需要匀速一段时间,沿直线前行80秒,共重复采集数据5次。由于压力计和惯性传感器采样率不一致,本发明实施例对采集到的压力计数据按照120HZ进行上采样操作。下面的数据和图片来 自于其中一次实验,因每次实验所采集的数据点过多,不便于全部展示,故选择开始和结束时的数据进行显示。The embodiment of the present invention collects inertial sensor and pressure sensor data at different motion speeds, wherein the inertial sensor uses Xsens Dot, and the pressure sensor uses the force sense technology insole pressure gauge RPPS-99, and the zero velocity phase detected by the pressure gauge is used as the gold Standard, to test and verify the proposed zero-speed detection method based on inertial sensor. In the embodiment of the present invention, the data of a subject is collected, aged 25, healthy and without disease in the lower limbs. Before the experiment, an inertial sensor (sampling rate 120HZ) was fixed on the outside of the ankle of the subject's feet, and a pressure gauge (sampling rate 50HZ) was placed in the two shoes at the same time. During the experiment, the subjects changed the forward speed according to their own ideas. After each speed change, they needed to move at a constant speed for a period of time, moving forward in a straight line for 80 seconds, and repeated data collection 5 times in total. Since the sampling rates of the pressure gauge and the inertial sensor are inconsistent, the embodiment of the present invention performs an up-sampling operation on the collected pressure gauge data at 120 Hz. The following data and pictures are from one of the experiments. Since there are too many data points collected in each experiment, it is not convenient to display them all, so the data at the beginning and end are selected for display.
基于欧几里得距离的站立/运动状态检测方法:实验的原理在第一步作了详细说明,实验结果图如图4和图5所示:附图4是开始运动时的数据,附图5是停止运动时的数据,其中粗实线是状态检测结果(为显示直观,给检测状态乘上100),值为200的区域是运动状态,值为100的区域是站立震动状态,值为0时是站立静止状态,可以看到运动前和运动后通常会出现站立震动状态,此时虽然没摆动腿,但传感器仍然有轻微的震动,该方法可以准确的区分出站立状态和运动状态。Standing/exercise state detection method based on Euclidean distance: the principle of the experiment is described in detail in the first step, and the experimental results are shown in Figure 4 and Figure 5: Accompanying drawing 4 is the data when starting to move, and the accompanying drawing 5 is the data when the motion is stopped, where the thick solid line is the state detection result (in order to display intuitively, multiply the detection state by 100), the area with a value of 200 is the motion state, the area with a value of 100 is the standing vibration state, and the value is 0 is the standing still state. You can see that there is usually a standing vibration state before and after the exercise. Although the legs are not swinging at this time, the sensor still has a slight vibration. This method can accurately distinguish the standing state from the exercise state.
自适应窗口大小和作用范围估计方法:首先需要检测双脚摆动过程swing,原理在前述作了说明,检测结果如图6和图7所示(为展示直观,故给swing乘上200),附图6是开始运动时的数据,附图7是停止运动时的数据,粗实线是摆动检测结果。Adaptive window size and range estimation method: firstly, it is necessary to detect the swing process of both feet. The principle is explained above. The detection results are shown in Figure 6 and Figure 7 (in order to show intuitively, the swing is multiplied by 200). Fig. 6 is the data when starting to move, and accompanying drawing 7 is the data when stopping to move, and the thick solid line is the swing detection result.
然后根据swing来确定决定窗口大小和作用范围的三种检测点,原理在第二步第2、3条做了详细说明。附图8就是实验求得的初始窗口值曲线,可以看到曲线会在某一值附近来回震荡,比如第50至80步之间虽然处于匀速阶段,但是窗口大小在55附近来回改变,所以需要进一步进行平滑操作。附图9就是平滑后的窗口值大小,可以看到匀速阶段的窗口值震荡情况被抑制,窗口大小更合理。Then determine the three detection points that determine the size of the window and the range of action according to the swing. The principle is explained in detail in the second step and item 2 and 3. Attached Figure 8 is the initial window value curve obtained by the experiment. It can be seen that the curve will oscillate back and forth around a certain value. For example, although it is in a constant speed stage between steps 50 and 80, the window size changes back and forth around 55, so it is necessary to Further smoothing operations. Attached Figure 9 is the smoothed window value size. It can be seen that the window value oscillation in the constant speed stage is suppressed, and the window size is more reasonable.
双脚角速度能量差值法:主要包括计算AREDD和极小值检测,实验的原理在前述做了说明,计算结果如下所示:从附图10中可以看到AREDD曲线拥有清晰的极小值点,极小值点都小于200并且靠近支撑相的中部位置。附图11是极小值点检测结果。Two-foot angular velocity energy difference method: mainly includes calculation of AREDD and minimum value detection. The principle of the experiment is explained above, and the calculation results are as follows: From Figure 10, it can be seen that the AREDD curve has a clear minimum value point , the minimum points are all less than 200 and close to the middle of the support phase. Accompanying drawing 11 is the minimum point detection result.
零速区间长度估计和零速区间范围调整方法:计算区间长度并结合极小值点即可确定初始零速区间,然后再调整初始零速区间范围,原理已在前述中详细描述,初始零速区间和调整后的零速区间如附图12所示:Zero-speed interval length estimation and zero-speed interval range adjustment method: Calculate the interval length and combine the minimum value points to determine the initial zero-speed interval, and then adjust the initial zero-speed interval range. The principle has been described in detail above. The initial zero-speed interval The interval and the adjusted zero-speed interval are shown in Figure 12:
最后,为验证本发明零速区间检测效果,本发明实施例使用压力计数据当作金标准来评估检测效果。本发明实施例检测结果同时包含左右脚的零速区间(判断某一区间属于左脚还是右脚的方法在前述已给出说明),垫在鞋子里的两只压力计各自提供左脚或右脚零速区间金标准,故每个压力计的零速区间数量要少一半,二者的检测结果对照如附图13所示(截取一段数据以方便展示)。从图13中可以看到,本发明实施例检测出的每一个零速区间都落入左脚或右脚压力计金标准范围内,无漏检,具有很好的准确度。Finally, in order to verify the detection effect in the zero-speed interval of the present invention, the embodiment of the present invention uses the pressure gauge data as a gold standard to evaluate the detection effect. The detection results of the embodiment of the present invention include the zero-speed interval of the left and right feet at the same time (the method for judging whether a certain interval belongs to the left foot or the right foot has been given in the foregoing description), and the two pressure gauges placed in the shoes provide the left or right foot respectively. Therefore, the number of zero-speed intervals of each pressure gauge should be reduced by half. The comparison of the test results of the two is shown in Figure 13 (a section of data is intercepted for easy display). It can be seen from FIG. 13 that each zero-speed interval detected by the embodiment of the present invention falls within the gold standard range of the left foot or right foot pressure gauge, without missing detection, and has good accuracy.
从以上实施例可以看出本发明通过提出了双脚角速度能量差值法,降低误检率,通过自适应窗口大小和作用范围估计的方法以及窗口震荡抑制方法,提高了能量差值法的性能。本发明采用双脚角速度欧几里得距离把用户状态分为站立静止状态、站立震荡状态和运动状态,解决了能量差值法不能处理前两种用户状态的问题。本发明基于双脚Z轴陀螺仪数据确定零速区间长度L,以极值点为中心把长为L的范围确定为初始零速区间,然后通过计算均值调整区间起始位置,有效减低误检率。It can be seen from the above embodiments that the present invention reduces the false detection rate by proposing the energy difference method of the angular velocity of both feet, and improves the performance of the energy difference method through the method of adaptive window size and range estimation and the window oscillation suppression method . The invention adopts the Euclidean distance of the angular velocity of both feet to divide the user state into a standing static state, a standing oscillating state and a moving state, and solves the problem that the energy difference method cannot handle the first two user states. The invention determines the length L of the zero-speed interval based on the Z-axis gyroscope data of both feet, and determines the range of length L as the initial zero-speed interval with the extreme point as the center, and then adjusts the initial position of the interval by calculating the mean value, effectively reducing false detection Rate.
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。In the above-mentioned embodiments, the descriptions of each embodiment have their own emphases, and for parts that are not detailed or recorded in a certain embodiment, refer to the relevant descriptions of other embodiments.
以上仅为本申请的可选实施例而已,并不用于限制本申请。对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的权利要求范围之内。The above are only optional embodiments of the application, and are not intended to limit the application. For those skilled in the art, various modifications and changes may occur in this application. Any modifications, equivalent replacements, improvements, etc. made within the spirit and principles of the present application shall be included within the scope of the claims of the present application.
本发明实施例的技术效果:本发明实施例公开的零速区间检测方法和装置 通过对目标屏幕上的标志物图案进行采集识别后通过光通信传输进行计算,用定位算法解析图片,获得标志物图片信息,获得图像采集装置与目标屏幕之间的相对位置信息完成定位。本发明的定位方法和装置基于目标屏幕与图像采集模块的光通信实现大范围高精度的行人导航系统的定位操作,利用设计的特定标志物图案进行辅助定位,使得定位计算不依赖图像匹配算法的效果,大大提升了定位的精度,且设备成本低,减小了环境因素对测距精度的影响,提高了工业应用时定位的稳定性。本发明实施例利用深度学习模型和传统图像处理的手段完成了标志物图案的识别,解决了由于摄像头远距离下标志物图像过小,无法识别标志物的问题。因此相比于其他摄像头定位技术,本方案大大提升了摄像头定位的作用范围。本发明实施例利用屏幕光通信机制,将屏幕的绝对位置传递给行人导航系统,使得定位的范围大大增加。Technical effect of the embodiment of the present invention: the zero-speed interval detection method and device disclosed in the embodiment of the present invention collect and identify the marker pattern on the target screen, then calculate through optical communication transmission, and use the positioning algorithm to analyze the picture to obtain the marker Image information, obtain the relative position information between the image acquisition device and the target screen to complete the positioning. The positioning method and device of the present invention realize the positioning operation of a large-scale and high-precision pedestrian navigation system based on the optical communication between the target screen and the image acquisition module, and use the designed specific marker pattern to assist positioning, so that the positioning calculation does not depend on the image matching algorithm. As a result, the positioning accuracy is greatly improved, and the equipment cost is low, the influence of environmental factors on the ranging accuracy is reduced, and the positioning stability in industrial applications is improved. The embodiments of the present invention use deep learning models and traditional image processing methods to complete the recognition of marker patterns, and solve the problem that markers cannot be recognized because the images of markers are too small at a long distance from the camera. Therefore, compared with other camera positioning technologies, this solution greatly improves the scope of camera positioning. The embodiment of the present invention utilizes the screen optical communication mechanism to transmit the absolute position of the screen to the pedestrian navigation system, so that the range of positioning is greatly increased.
结合本文中所公开的实施例描述的方法或算法的步骤可以用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其它形式的存储介质中。The steps of the methods or algorithms described in connection with the embodiments disclosed herein may be implemented by hardware, software modules executed by a processor, or a combination of both. Software modules can be placed in random access memory (RAM), internal memory, read-only memory (ROM), electrically programmable ROM, electrically erasable programmable ROM, registers, hard disk, removable disk, CD-ROM, or any other Any other known storage medium.
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本发明中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本发明所示的这些实施例,而是要符合与本发明所公开的原理和新颖特点相一致的最宽的范围。The above description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the general principles defined in this invention may be implemented in other embodiments without departing from the spirit or scope of the invention. Therefore, the present invention will not be limited to these embodiments shown in the present invention, but will conform to the widest scope consistent with the principles and novel features disclosed in the present invention.

Claims (10)

  1. 一种零速区间检测方法,应用于行人导航系统,其特征在于,包括:A zero-speed interval detection method applied to a pedestrian navigation system, characterized in that it includes:
    S1,数据采集:利用陀螺仪对行人的双脚进行数据采集;S1, data acquisition: use the gyroscope to collect data on the feet of pedestrians;
    S2,确定自适应能量窗口和作用范围:通过所述采集的数据确定角速度能量差值探测器AREDD中自适应能量窗口值和作用范围;S2. Determine the adaptive energy window and the scope of action: determine the value of the adaptive energy window and the scope of action in the angular velocity energy difference detector AREDD through the collected data;
    S3,角速度能量差值探测器参数确定:根据所述自适应能量窗口值分别计算左右脚ARED值相减后取绝对值,然后进行极小值点检测;S3, determining the parameters of the angular velocity energy difference detector: calculating the ARED values of the left and right feet respectively according to the adaptive energy window value, and then taking the absolute value, and then detecting the minimum value point;
    S4,区间长度估计:通过陀螺仪Z轴数据分割点间隔确定每一步的区间长度,然后根据该长度在极值点周围划分出初始零速区间;S4, Interval Length Estimation: Determine the interval length of each step through the gyroscope Z-axis data segmentation point interval, and then divide the initial zero-speed interval around the extreme point according to the length;
    S5,区间调整:计算陀螺仪Z轴数据在初始零速区间范围内、向左和向右移一个采样点的均值后,把初始零速区间移向均值较小的那一方,获得调整后的零速区间。S5, Interval adjustment: After calculating the mean value of the gyro Z-axis data within the initial zero-speed interval, moving one sampling point to the left and right, move the initial zero-speed interval to the side with a smaller average value, and obtain the adjusted Zero speed range.
  2. 根据权利要求1所述的方法,其特征在于,所述步骤S2,确定自适应能量窗口和作用范围具体为:利用双脚陀螺仪Z轴数据的周期性确定角速度能量差值确定角速度能量差值探测器AREDD中窗口的大小和作用范围。The method according to claim 1, characterized in that, the step S2, determining the adaptive energy window and the scope of action is specifically: using the periodicity of the biped gyroscope Z-axis data to determine the angular velocity energy difference to determine the angular velocity energy difference The size and scope of the window in the detector AREDD.
  3. 根据权利要求1所述的方法,其特征在于,在所述步骤S1,数据采集后还包括步骤:站立状态检测。The method according to claim 1, characterized in that, after the data collection in the step S1, further comprising the step of: standing state detection.
  4. 根据权利要求3所述的方法,其特征在于,在所述步骤站立状态检测具体为:利用陀螺仪数据计算双脚间的欧几里得距离来划分站立和行走状态。The method according to claim 3, wherein the detection of the standing state in the step specifically comprises: using the gyroscope data to calculate the Euclidean distance between the feet to divide the standing state and the walking state.
  5. 根据权利要求4所述的方法,其特征在于,在所述步骤站立状态检测还包括:检测出的站立静止状态部分数据判断属于零速区间,检测出行走状态,则进行步骤S2:确定自适应能量窗口和作用范围。The method according to claim 4, wherein the standing state detection in said step also includes: the detected standing still state partial data is judged to belong to the zero-speed interval, and the walking state is detected, then step S2 is performed: determining the self-adaptive Energy window and range of action.
  6. 根据权利要求2所述的方法,其特征在于,所述利用双脚陀螺仪Z轴数据的周期性确定角速度能量差值确定角速度能量差值探测器AREDD中窗口的大小时还包括:对窗口值进行平滑操作。The method according to claim 2, wherein the periodic determination of the angular velocity energy difference using the biped gyroscope Z-axis data to determine the size of the window in the angular velocity energy difference detector AREDD also includes: window value for smoothing.
  7. 根据权利要求4所述的方法,其特征在于,所述陀螺仪数据为陀螺仪Z轴数据。The method according to claim 4, wherein the gyroscope data is gyroscope Z-axis data.
  8. 根据权利要求1所述的方法,其特征在于,所述采集的数据包括:双脚步态信号。The method according to claim 1, characterized in that the collected data includes: two-foot gait signals.
  9. 一种行人导航系统,其特征在于,包括:A pedestrian navigation system, characterized in that it includes:
    零速区间检测装置,设于行人身上,并基于所述行人的运动状态获取信号;The zero-speed interval detection device is installed on the pedestrian and acquires a signal based on the motion state of the pedestrian;
    处理器;processor;
    存储器,存储有能够被所述处理器读取的计算机指令,当所述计算机指令被读取时,所述处理器执行根据权利要求1至8任一项所述的方法。A memory storing computer instructions that can be read by the processor, and when the computer instructions are read, the processor executes the method according to any one of claims 1 to 8.
  10. 一种存储介质,其特征在于,用于存储计算机可读指令,所述计算机可读指令用于使计算机执行根据权利要求1至8任一项所述的方法。A storage medium is characterized in that it is used for storing computer-readable instructions, and the computer-readable instructions are used for causing a computer to execute the method according to any one of claims 1 to 8.
PCT/CN2021/138455 2021-12-15 2021-12-15 Zero-speed interval detection method, pedestrian navigation system and storage medium WO2023108498A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2021/138455 WO2023108498A1 (en) 2021-12-15 2021-12-15 Zero-speed interval detection method, pedestrian navigation system and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2021/138455 WO2023108498A1 (en) 2021-12-15 2021-12-15 Zero-speed interval detection method, pedestrian navigation system and storage medium

Publications (1)

Publication Number Publication Date
WO2023108498A1 true WO2023108498A1 (en) 2023-06-22

Family

ID=86775053

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/138455 WO2023108498A1 (en) 2021-12-15 2021-12-15 Zero-speed interval detection method, pedestrian navigation system and storage medium

Country Status (1)

Country Link
WO (1) WO2023108498A1 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20120136573A1 (en) * 2010-11-25 2012-05-31 Texas Instruments Incorporated Attitude estimation for pedestrian navigation using low cost mems accelerometer in mobile applications, and processing methods, apparatus and systems
CN106225786A (en) * 2016-08-15 2016-12-14 北京理工大学 A kind of adaptive pedestrian navigation system zero-speed section detecting method
CN108362282A (en) * 2018-01-29 2018-08-03 哈尔滨工程大学 A kind of inertia pedestrian's localization method based on the adjustment of adaptive zero-speed section
CN110455316A (en) * 2019-08-27 2019-11-15 哈尔滨工业大学 A kind of adaptive zero-speed section detecting method
CN110987004A (en) * 2019-12-02 2020-04-10 北京自动化控制设备研究所 Ship inertial navigation alignment method based on zero-speed matched filtering
CN111707294A (en) * 2020-08-20 2020-09-25 中国人民解放军国防科技大学 Pedestrian navigation zero-speed interval detection method and device based on optimal interval estimation

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20120136573A1 (en) * 2010-11-25 2012-05-31 Texas Instruments Incorporated Attitude estimation for pedestrian navigation using low cost mems accelerometer in mobile applications, and processing methods, apparatus and systems
CN106225786A (en) * 2016-08-15 2016-12-14 北京理工大学 A kind of adaptive pedestrian navigation system zero-speed section detecting method
CN108362282A (en) * 2018-01-29 2018-08-03 哈尔滨工程大学 A kind of inertia pedestrian's localization method based on the adjustment of adaptive zero-speed section
CN110455316A (en) * 2019-08-27 2019-11-15 哈尔滨工业大学 A kind of adaptive zero-speed section detecting method
CN110987004A (en) * 2019-12-02 2020-04-10 北京自动化控制设备研究所 Ship inertial navigation alignment method based on zero-speed matched filtering
CN111707294A (en) * 2020-08-20 2020-09-25 中国人民解放军国防科技大学 Pedestrian navigation zero-speed interval detection method and device based on optimal interval estimation

Similar Documents

Publication Publication Date Title
JP6374107B2 (en) Improved calibration for eye tracking system
US20170095181A1 (en) System and method for characterizing biomechanical activity
US10653339B2 (en) Time and frequency domain based activity tracking system
KR102292683B1 (en) Method and apparatus for gait task recognition
CN113164098A (en) Human gait analysis system and method
US20200056904A1 (en) Technologies for pedestrian dead reckoning
CN108634960B (en) A kind of gait online test method for ectoskeleton wearer
TWI640931B (en) Image object tracking method and apparatus
CN111288986B (en) Motion recognition method and motion recognition device
WO2019047410A1 (en) Method and apparatus for counting the number of steps
WO2021169704A1 (en) Method, device and apparatus for determining depth of gesture, and storage medium
JP2004298285A (en) Judgment device and judgment method of walking condition and pedestrian attribute
CN108836344A (en) Step-length cadence evaluation method and device and gait detector
US11497443B2 (en) Smart shoe based on recognition of combined walking action and data processing method thereof
US10466054B2 (en) Method and system for estimating relative angle between headings
KR20190009006A (en) Real time multi-object tracking device and method by using global motion
WO2023108498A1 (en) Zero-speed interval detection method, pedestrian navigation system and storage medium
JP2012181710A (en) Object tracking device, method and program
CN112741617A (en) CSI-based omnidirectional gait detection algorithm
CN114279441B (en) Zero-speed interval detection method, pedestrian navigation system and storage medium
KR101394279B1 (en) Method for recognition of user&#39;s motion by analysis of depth image and apparatus for analyzing user&#39;s motion using the same
KR101713496B1 (en) System and method for zero-delay real time step detection utilizing an accelerometer sensor
JP6147446B1 (en) Inertial sensor initialization using soft constraints and penalty functions
TWI579021B (en) Analyzing system and method for evaulating calories consumption by detecting the intensity of wireless signal
CN111359194A (en) Walking feature dimension reduction method for three-dimensional behavior space of humanoid intelligent body

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21967634

Country of ref document: EP

Kind code of ref document: A1