WO2018081986A1 - Wearable device and real-time step length measurement method for device - Google Patents

Wearable device and real-time step length measurement method for device Download PDF

Info

Publication number
WO2018081986A1
WO2018081986A1 PCT/CN2016/104465 CN2016104465W WO2018081986A1 WO 2018081986 A1 WO2018081986 A1 WO 2018081986A1 CN 2016104465 W CN2016104465 W CN 2016104465W WO 2018081986 A1 WO2018081986 A1 WO 2018081986A1
Authority
WO
WIPO (PCT)
Prior art keywords
leg
thigh
sensor
angular velocity
axis
Prior art date
Application number
PCT/CN2016/104465
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/CN2016/104465 priority Critical patent/WO2018081986A1/en
Publication of WO2018081986A1 publication Critical patent/WO2018081986A1/en

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00Measuring for diagnostic purposes; Identification of persons
    • A61B5/103Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/11Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb

Definitions

  • the invention belongs to the field of wearable sensors, and in particular relates to a wearable device and a real-time step measurement method for the same.
  • Gait parameters are physical parameters during human walking, which can reflect human exercise ability and have great application value. Therefore, many researchers are currently studying the measurement of gait parameters. Wearable sensors include inertial measurement units, ultrasonic sensors, miniature cameras, etc., compared to large laboratory equipment that measure gait parameters such as optical motion capture systems, force gauges, etc., which are small, inexpensive, and free of time. The advantages of space limitation and easy promotion are widely used in the field of gait parameter measurement. At present, there are many studies using wearable sensors placed on the legs, waist, wrists, chest, etc. to measure gait time parameters, such as gait events, gait cycles, etc.; some also measure gait space parameters, such as walking speed. , step and so on. For example, the invention patent No.
  • CN201510887154.1 discloses an indoor positioning step calculation method, which places the inertial measurement unit at the waist of the person, and the person obtains the inertial sensor data of the person during the indoor walking process, and then calculates the step size.
  • the invention patent of the application No. CN 201310007945.1 discloses a step calculation method and device for acquiring the acceleration values of the respective axes in the three-dimensional coordinate system; calculating the step compensation coefficient according to the acceleration values of the respective axes; The long compensation factor and the preset preset step size determine the final step size of the carrier's movement amplitude.
  • there are defects such as low gait measurement accuracy and inability to measure single step in real time.
  • step and pace can be used to reflect the lower limbs' ability to move.
  • the step and pace cannot reflect the difference in the ability of the two sides of the human body caused by hemiplegia, that is, the gait is not correct, and we can quantify the asymmetry of the gait on both sides of the human body according to the ratio of the two-leg steps, and
  • the length can also be used to find parameters such as step size and pace, so the step size has greater clinical application value.
  • the real-time step size can reflect the user's real-time displacement information, matching the user's real-time lower limbs.
  • the posture information can be used for mechanical devices related to lower limb movement such as a biped robot, a lower limb assisted rehabilitation device, and the like.
  • the use of wearable sensors to calculate step sizes has a wide range of applications. Therefore, it is necessary to propose a step size measurement method that takes into consideration the measurement accuracy and performs the measurement.
  • the object of the present invention is to solve the defects in the prior art that the gait measurement accuracy is low, the single step size cannot be measured in real time, and the wearable device and the real-time step measurement method for the device are provided.
  • the step distance refers to the distance between the places where the same foot is adjacent during the walking of the person
  • the step size refers to the distance between the adjacent places of the feet during the walking of the person. In general, the step size is equal to the sum of the two leg steps.
  • Gait events refer to important moments in each gait cycle of a person during walking. There are five gait events in the middle of swing, straight legs, foot landing, middle stance, and foot off the ground.
  • the walking gait cycle of a person is shown in Figure 4. Taking the right leg as an example, the left leg supports the human body, and the right leg takes the forward phase as the swinging phase of the right leg; when the right leg swings to the vicinity of the left leg, it swings.
  • Gait events can be detected based on the angular velocity characteristics of the ipsilateral calf and thigh, as shown in Figure 5.
  • the angular velocity of the calf usually has two relatively large peaks in one cycle, one high and one short, the higher peak corresponds to the middle of the swing, the shorter one corresponds to the middle of the middle; the middle of the swing has a small number of small negative peaks. In the area, this is the vibration caused by the landing of the foot.
  • the first negative peak is the moment of the foot landing; between the middle of the swing and the moment of the foot landing, there is a thigh, calf angular velocity intersecting, at this moment for the leg straightening moment; After the middle of the next swing, there is a trough, which corresponds to the moment when the foot is off the ground.
  • the standing phase starts from the landing of the leg and ends, and the end of the foot is off the ground.
  • the approximate angle is the area where the angular velocity of the lower leg is negative.
  • the swing phase starts from the leg and ends from the ground to the end of the foot landing.
  • the approximate angular velocity of the lower leg is positive. The area of the value.
  • the real-time step size measurement refers to the step size of the step when the gait event of the forefoot landing is detected.
  • the sagittal plane and the plumb line are shown in Figure 1.
  • the sagittal plane is perpendicular to the horizontal plane and divides the human body into two parts. The main movement occurs in the sagittal plane when walking.
  • the plumb line is A line perpendicular to the ground.
  • the X-axis is parallel to the calf or thigh; the Y-axis is in the sagittal plane, perpendicular to the calf or thigh; the Z-axis is perpendicular to the sagittal plane .
  • the axis of the sensor on the thigh or calf should be consistent with the thigh or calf, but because the sagittal plane is invisible, the Y-axis and Z-axis shift will occur in the sensor, and the Y measured according to the sensor.
  • the angular velocity of the axis and the Z-axis can roughly calculate the angle of the sagittal plane of the Y-axis of the sensor, and use this angle to calculate the acceleration and angular velocity of the corresponding axis of the thigh or the lower leg.
  • the thigh length of the human body is the vertical height from the hip joint to the knee joint when the human body stands still; the calf length is the vertical height of the knee joint to the ground at this time.
  • the present invention solves the technical problem, and the specific technical solutions adopted are as follows:
  • a real-time step size measurement method for a wearable device including the following steps:
  • the Y-axis acceleration and the Z-axis angular velocity during the walking of the thighs and calves on both sides of the user are measured in real time, and the gait events during walking are determined in real time according to the Z-axis angular velocity; the thighs and the calves are determined in real time according to the gait events and the Z-axis angular velocity integrals.
  • the angle between the sagittal plane and the plumb line; the real-time step size is calculated based on the angle and the length of the thigh and the calf.
  • the calculation of the step size can be calculated based on the geometric relationship of the lower limbs during walking.
  • the wearable device includes a sensor for detecting triaxial acceleration and triaxial angular velocity of the left and right thighs and the left and right calves, and the Y-axis acceleration and the Z-axis angular velocity are obtained by a sensor.
  • the gait event includes landing of the foot, middle of standing, and straightening of the leg;
  • ⁇ lsms and ⁇ rsms are the angles of the left lower leg and the right lower leg in the middle of the standing with the plumb line
  • a lsyms and a rsyms are the Y-axis accelerations of the left lower leg and the right lower leg respectively
  • ⁇ l0 , ⁇ r0 is the angle between the left calf and the right calf in the sagittal plane and the plumb line in the static standing state of the user (the standing state of the feet naturally standing), and satisfies:
  • a lsys and a rsys are the Y-axis accelerations of the left calf and the right calf when the user is standing statically;
  • the angle between the calf of the leg and the plumb line in the sagittal plane is calculated in real time by angular velocity integration:
  • t is the time of the last standing middle distance from the left or lower calf at the current time
  • ⁇ ls (t), ⁇ rs (t) are the left calf and the right calf in the sagittal plane and plumb at time t
  • the angle of the line, ⁇ lsz ( ⁇ ), ⁇ rsz ( ⁇ ) are the instantaneous Z-axis angular velocity of the left lower leg and the right lower leg respectively;
  • ⁇ ltls, ⁇ rtls respectively, left thigh, right thigh at the time the legs straight in the sagittal plane and the angle between the vertical line, ⁇ lsls, ⁇ rsls case were left leg, right leg in the sagittal The angle between the surface and the plumb line;
  • the angle between the thigh of the leg and the plumb line in the sagittal plane is calculated in real time by angular velocity integration:
  • t is the time after the last leg of the left thigh or right thigh is straightened
  • ⁇ lt (t), ⁇ rt (t) are the angles between the left thigh, the right thigh and the plumb line at time t, respectively
  • ⁇ ltz ( ⁇ ), ⁇ rtz ( ⁇ ) are the instantaneous Z-axis angular velocities of the left thigh and the right thigh, respectively;
  • RSL l 1 (sin(- ⁇ rtic )+sin ⁇ ltic )+ 2 (sin(- ⁇ rsic )+sin ⁇ lsic )
  • ⁇ lsic , ⁇ rsic , ⁇ ltic , ⁇ rtic are the angles of the left leg, the right leg, the left thigh, the right thigh and the plumb line at the time of landing of the leg, respectively
  • l 1 and l 2 are the thigh length, respectively.
  • the calf is long
  • the LSL is the step length of the leg when the left leg is landing
  • the RSL is the step length of the leg when the right leg is landing.
  • the walking process within a certain distance of the target user is monitored in advance, and the angle of the actual direction of the sensor Y-axis from the sagittal plane is determined:
  • the Y-axis acceleration and Z-axis angular velocity data of each sensor are corrected in advance before being substituted into the above formulas, as the acceleration or angular velocity of the corresponding direction of the lower leg or thigh, the correction formula is:
  • a y is the Y-axis acceleration measured by the sensor
  • a z is the Z-axis acceleration measured by the sensor
  • a yc is the Y-axis acceleration obtained by correcting the data of the sensor
  • ⁇ y is the Y-axis angular velocity measured by the sensor
  • ⁇ z is the Z-axis angular velocity measured by the sensor
  • ⁇ zc is the Z-axis angular velocity obtained by correcting the data of the sensor.
  • Another object of the present invention is to provide a method for measuring gait asymmetry, which measures the real-time step size according to the above method, and then quantifies the gait asymmetry of the user with unilateral motion disorder, and the calculation formula is as follows:
  • GA gait asymmetry
  • the inertial sensor is first connected to a single chip microcomputer, a single chip microcomputer and a bluetooth mode. Blocks are connected, and the upper computer and the Bluetooth module exchange data through Bluetooth.
  • a fixing strap for fixing the inertial sensor is also included.
  • the inertial sensor is an inertial sensor based on the MPU6050 chip.
  • the inertial sensor sampling frequency is not less than 100 Hz.
  • the invention has the following beneficial effects:
  • the step size measurement by the wearable device can conveniently and effectively quantify the movement ability of the human body and their differences, and can be conveniently applied to the clinic.
  • the present invention can output the lower limb posture and the step size in real time, and can be used for real-time control of related devices.
  • Figure 1 is a schematic view showing a sagittal plane and a plumb line in the present invention
  • FIG. 2 is a schematic view showing the position of the sensor and the coordinate system of the lower leg and the thigh in the present invention
  • Figure 3 is a structural diagram of a wearable real-time step size measuring system in the present invention.
  • Figure 4 is a schematic view showing the walking cycle of the human body in the present invention.
  • Figure 5 is a schematic diagram of gait event detection in the present invention.
  • FIG. 6 is a schematic view showing a two-dimensional geometric model of a double inverted pendulum of a lower limb in the present invention.
  • Figure 7 is a schematic view showing the mid-angle of the right lower leg swing in the present invention.
  • P represents a plumb line
  • S represents a sagittal plane (Sagittal Plane)
  • 1 to 4 are inertial sensor units placed on the left thigh, the left lower leg, the right thigh, and the right lower leg, respectively, and 5 is a host computer unit;
  • a to E are gait events of the right leg in a gait cycle, where A is the mid-swing gait event, B is the leg extension gait event, and C is the foot landing gait event. D is the mid-term gait event, and E is the foot gait event.
  • the present invention uses a wearable device including four inertial measurement sensors and a geometry-based algorithm to calculate and output the lower limb posture and step size of the user while walking.
  • the real-time step size measurement refers to the step size of the step when the gait event of the forefoot landing is detected.
  • the target user has a thigh length of 42 cm and a calf length of 53 cm, which is input into the upper computer of the wearable device, and then the user wears the wearable device.
  • Each of the four inertial sensor units includes an inertial measurement sensor module based on the MPU6050 chip.
  • the module includes a three-dimensional accelerometer and a three-dimensional gyroscope for collecting three-dimensional acceleration and three-dimensional angular velocity data during the user's walking.
  • the sampling frequency is 100Hz.
  • the four sensor units are placed on the outside of the user's two thighs and two calves.
  • the X-axis is parallel to the calf or thigh; the Y-axis is in the sagittal plane, perpendicular to the calf or thigh; the Z-axis is perpendicular to the sagittal plane.
  • the axis of the sensor placed on the thigh or calf should be consistent with the thigh or calf to collect data for the corresponding axis.
  • the sensor unit on the lower leg comprises an elastic fixing strap to the MPU6050 sensor module; the sensor unit on the thigh comprises a battery, a fixing strap, a single chip microcomputer, an MPU6050 sensor module and a Bluetooth transmission module.
  • the fixing strap is used for fixing the sensor unit to the user's leg;
  • the single-chip microcomputer in the thigh sensor unit is connected with each module in the unit, and is also connected with the MPU6050 sensor module in the same-side calf sensor unit through the wire for preliminary use.
  • the Bluetooth module is used for communication between the inertial sensor unit and the host unit.
  • the upper unit structure includes a Bluetooth module, a single chip microcomputer, a button, a battery, and an OLED display.
  • the single-chip microcomputer is used to process data; the button and the OLED display form an operation interface, which is convenient for the user to use.
  • the X axis is parallel to the calf or thigh; the Y axis is in the sagittal plane, perpendicular to the calf or thigh; the Z axis is perpendicular to the sagittal plane
  • the sensor detects Data needs to be dynamically corrected and statically calibrated before use.
  • the modified Y-axis acceleration needs to be filtered by a low-pass filter with a cutoff frequency of 3.2 Hz for later use. Subsequent steps require stepwise calculation using the filtered Y-axis acceleration data of the sensor unit and the corrected Z-axis angular velocity data.
  • Dynamic correction is a constant correction of the Y- and Z-axis data of the sensors on the thigh or calf.
  • the X axis of the sensor can be roughly parallel to the thigh or the lower leg, but the sagittal plane is invisible, the sensor placement position is prone to deviation, and the Y and Z axes of the sensor are more likely to be in the plane they form. Offset, so you need to determine the angle at which the Y axis deviates from the sagittal plane
  • the dynamic correction is as follows:
  • the Y-axis and Z-axis angular velocity detected by the sensor are used to determine the angle of the actual Y-axis of the sensor from the sagittal plane:
  • the Y-axis acceleration and Z-axis angular velocity data of each sensor are corrected in advance before use as the acceleration or angular velocity of the calf or thigh in the corresponding direction:
  • a y is the Y-axis acceleration measured by the sensor
  • a z is the Z-axis acceleration measured by the sensor
  • a yc is the Y-axis acceleration obtained by correcting the data of the sensor
  • ⁇ y is the Y-axis angular velocity measured by the sensor
  • ⁇ z is the Z-axis angular velocity measured by the sensor
  • ⁇ zc is the Z-axis angular velocity obtained by correcting the data of the sensor.
  • the static calibration is to calibrate the zero point of the angle between the calf and the plumb line. Because the subsequent calculation requires the angle between the calf and the plumb line, after the user adjusts the sensor position, the X axis can be kept parallel with the calf, but it is difficult to achieve a precise parallel state. At this time, the X axis is regarded as the direction of the calf, which will cause There is a certain amount of error, so it is necessary to recalibrate the calf direction.
  • the static calibration is as follows:
  • ⁇ l0 , ⁇ r0 are the angle between the left calf and the right calf X axis of the user in the static standing state and the plumb line in the sagittal plane, respectively, a lsys and a rsys are the left calf of the user when standing statically, Y-axis acceleration of the right lower leg.
  • the user walks on a flat ground, and four inertial sensors collect acceleration and angular velocity data in real time.
  • the MCU uses the corresponding algorithm to detect gait events.
  • the walking gait cycle of a person is shown in Fig. 4. In one cycle, there are mainly five gait events of mid-swing A, leg straight B, foot landing C, standing mid-D, and foot off-E, which need to be detected in this method.
  • the gait event is the landing of the foot, the middle of the stance, and the straightening of the legs.
  • the Z-axis angular velocity of the calf and thigh on the same side can detect the gait event in each gait cycle of the user's side leg in real time, as shown in FIG.
  • the foot landing event is the moment of landing before the forefoot during the walking process, occurring at the first negative trough in the angular velocity vibration region after the highest peak of the calf angular velocity in each gait cycle, that is, the first after the highest peak Negative turning point, and can be detected immediately after it occurs;
  • the middle of the standing is the leg as the supporting leg, moving to the position close to the vertical and the ground, at the small short peak of the angular velocity of the lower leg, and the peak value is negative
  • the middle of the swing and the landing event there is a moment when the angular velocity of the thigh is equal to the angular velocity of the lower leg, that is, the moment when the leg straightening event occurs, at which time the user's leg swings and straightens in the forward direction.
  • the angle between the thigh and the calf in the sagittal plane and the plumb line during walking is calculated in real time.
  • the lower limbs of the human body are simplified into a two-dimensional geometric model of the double pendulum, and the user's motion is simplified into a plane motion in the sagittal plane.
  • the lower leg and the thigh are simplified into a rod, and the hip joint and the two knee joints are simplified as Hinge.
  • the simplified rod model of the thigh and the calf is perpendicular to the ground when the human body stands still, that is, the angle with the plumb line is 0, thereby obtaining the left and right calf simplified rod model and the
  • the angle of the X-axis of the calf is ⁇ l0 and ⁇ r0 .
  • the real-time angle between the thigh and the calf during the walking process and the plumb line is mainly obtained by real-time integration of the Z-axis angular velocity, but as the integration time goes on, the integral error will become larger and larger, so it needs to be in each cycle. They are recalibrated once.
  • ⁇ lsms and ⁇ rsms are the angles between the left lower leg and the right lower leg in the middle of the standing and the vertical line
  • a lsyms and a rsyms are respectively corrected by a low-pass filter with a cutoff frequency of 3.2 Hz.
  • the angle between the real left left leg, the right calf and the plumb line above the angle of the standing mid-point calibration is taken as the starting point, calculated by the angular velocity integral:
  • t is the time from the middle of the left or lower calf
  • ⁇ ls (t) are the angles between the left calf, the right calf and the plumb line at time t
  • ⁇ Lsz ( ⁇ ) is the instantaneous Z-axis angular velocity of the left lower leg and the right lower leg.
  • the thigh angle is approximately in a straight line, thereby calculating the angle between the thigh and the plumb line of the leg.
  • the angle between the real left thigh, the right thigh and the plumb line is calculated by the angular velocity integral before the next leg extension event is detected:
  • t is the time after the last leg of the left thigh or right thigh is straightened
  • ⁇ lt (t), ⁇ rt (t) are the angles between the left thigh, the right thigh and the plumb line at time t, respectively
  • ⁇ ltz ( ⁇ ), ⁇ rtz ( ⁇ ) are the instantaneous Z-axis angular velocities of the left thigh and the right thigh.
  • the calculation in the above steps is mainly completed in the single-chip microcomputer in the thigh inertial sensor unit, and then the result of the real-time detection of the gait event and the real-time angle of the thigh and the calf are transmitted to the upper computer unit through Bluetooth.
  • the host computer calculates the step size of the user's leg by real-time calculation of the geometric model as shown in FIG. 6:
  • RSL l 1 (sin(- ⁇ rtic )+sin ⁇ ltic )+ 2 (sin(- ⁇ rsic )+sin ⁇ lsic )
  • ⁇ lsic , ⁇ rsic , ⁇ ltic , ⁇ rtic are the angles of the left calf, the right calf, the left thigh, the right thigh and the plumb line at the time of landing of the leg of the leg calculated in step (3), respectively.
  • 1 and l 2 are the length of the thigh and the length of the calf, respectively.
  • the LSL is the step length of the leg when the left leg is landing
  • the RSL is the step length of the leg when the right leg is landing.
  • the calculated step size results can be displayed directly on the OLED display in real time or sent to other devices via the serial port.
  • the step size of each step of the user is measured by the above method. After the user finishes walking, if the user has dyskinesia on one side of the lower limb, the gait asymmetry of the user can also be quantified:
  • GA gait asymmetry
  • the average of the left leg step and the right leg step respectively.
  • the user has no lower extremity dyskinesia.
  • the step measurement process a total of 22 steps are taken. Each step can be detected in real time and the step size is calculated in real time.
  • the root mean square error of all steps measured by the process is 3.9 cm, which is 6.2% of the user's actual average step size (63.1 cm); it is assumed that the user's left leg is motion
  • the actual gait asymmetry is 0.503
  • the measured value of the process is 0.508 with an error of 0.005. It can be seen that the device and method of the present invention can not only realize real-time measurement of step size and gait asymmetry, but also actual precision thereof. The degree has also been greatly improved.
  • the embodiments described above are only some of the preferred embodiments of the present invention, but are not intended to limit the present invention.
  • Various changes and modifications can be made by those skilled in the art without departing from the spirit and scope of the invention.
  • the above embodiment may also use other algorithms or use other sensors to calculate the angle of the thigh and the calf in real time, such as using an accelerometer, a gyroscope, and a magnetic field sensor fusion to calculate the angles of the left and right thighs and the calves by using a Kalman filter algorithm.
  • the step size calculation is further performed using the geometric model of FIG. 6.
  • the above-mentioned wearable device may also adopt other structures in the prior art or modify the device shown in the drawing.
  • the wired connection in the original device is removed, and all the four inertial sensors are wirelessly communicated for more convenient use.
  • the single chip microcomputer can also be integrated in the upper computer unit.
  • the host computer unit can also be in the form of a remote PC or the like.
  • the step of correcting the data collected by the sensor placed on the leg may be omitted, and the sensor data is directly used for the step length measurement process. .

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Medical Informatics (AREA)
  • Physics & Mathematics (AREA)
  • Dentistry (AREA)
  • Biophysics (AREA)
  • Pathology (AREA)
  • Physiology (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Molecular Biology (AREA)
  • Surgery (AREA)
  • Animal Behavior & Ethology (AREA)
  • General Health & Medical Sciences (AREA)
  • Public Health (AREA)
  • Veterinary Medicine (AREA)
  • Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)

Abstract

A wearable device and a real-time step length measurement method for the device. A two-dimensional gait of a lower limb when a user walks and step length information of each step can be measured and outputted in real time, and the device and the method can be applied to detection of a gait asymmetry degree of the user. By using angular velocity and acceleration real-time data collected by four inertial sensor units, the lower-limb gesture and the step length of the user are computed and outputted by means of a geometric algorithm. The device is convenient to use, is not limited by sites, has low costs, can highly-accurately output the lower-limb gesture and the step length of the user in real time, and has high reliability and good promotion prospects.

Description

一种可穿戴式设备及用于该设备的实时步长测量方法Wearable device and real-time step size measuring method therefor 技术领域Technical field
本发明属于可穿戴传感器领域,具体涉及一种可穿戴式设备及用于该设备的实时步长测量方法。The invention belongs to the field of wearable sensors, and in particular relates to a wearable device and a real-time step measurement method for the same.
背景技术Background technique
步态参数是人类行走过程中的物理参数,可以反映人类运动能力,拥有较大的应用价值,因此目前有许多研究者在研究步态参数的测量。可穿戴传感器包括惯性测量单元,超声波传感器,微型摄像头等等,相比于大型实验室测量步态参数的设备如光学式运动捕捉系统、测力台等等,以其小巧、廉价,不受时间、空间限制、易于推广等优点被广泛应用于步态参数测量领域。目前有很多研究使用放置在人体腿部、腰部、手腕、胸部等部位的可穿戴传感器测量步态时间参数,如步态事件、步态周期等等;也有的测量步态空间参数,如步行速度、步距等等。如申请号为CN201510887154.1的发明专利公开了一种室内定位步长计算方法,将惯性测量单元置于人员的腰部,人员在室内行走过程中,获得人员惯性传感器数据,然后计算步长。而申请号为CN 201310007945.1的发明专利公开了一种步长计算方法和装置,获取载体在三维坐标系中的各轴加速度值;根据所述各轴加速度值计算步长补偿系数;根据所述步长补偿系数和预先设定的预设步长确定载体移动幅度的最终步长。但上述方法再实际使用过程中,均存在步态测量精度较低、无法实时测量单步步长等缺陷。Gait parameters are physical parameters during human walking, which can reflect human exercise ability and have great application value. Therefore, many researchers are currently studying the measurement of gait parameters. Wearable sensors include inertial measurement units, ultrasonic sensors, miniature cameras, etc., compared to large laboratory equipment that measure gait parameters such as optical motion capture systems, force gauges, etc., which are small, inexpensive, and free of time. The advantages of space limitation and easy promotion are widely used in the field of gait parameter measurement. At present, there are many studies using wearable sensors placed on the legs, waist, wrists, chest, etc. to measure gait time parameters, such as gait events, gait cycles, etc.; some also measure gait space parameters, such as walking speed. , step and so on. For example, the invention patent No. CN201510887154.1 discloses an indoor positioning step calculation method, which places the inertial measurement unit at the waist of the person, and the person obtains the inertial sensor data of the person during the indoor walking process, and then calculates the step size. The invention patent of the application No. CN 201310007945.1 discloses a step calculation method and device for acquiring the acceleration values of the respective axes in the three-dimensional coordinate system; calculating the step compensation coefficient according to the acceleration values of the respective axes; The long compensation factor and the preset preset step size determine the final step size of the carrier's movement amplitude. However, in the actual use of the above methods, there are defects such as low gait measurement accuracy and inability to measure single step in real time.
实时步长的测定具有重要的意义。现在有很多研究用可穿戴传感器测量步速、步距等空间参数,比较成熟,但是测量步长的研究不多。一些疾病如帕金森综合征会使人体运动能力下降,步速、步距减小,因此步距和步速可以用来反映人体下肢运动能力。但是步距、步速不能反映出偏瘫造成的人体两侧运动能力的差异,即步态不对性,而我们可以根据两腿步长的比值量化人体两侧步态的不对称性,而且通过步长也可以求出步距、步速等参数,因此步长拥有更大的临床应用价值。除此之外,实时的步长可以反映使用者实时的位移信息,搭配使用者实时的下肢 姿态信息,可以对与下肢运动相关的机械装置如二足机器人、下肢辅助康复装置等等。使用可穿戴传感器计算步长具有广泛的应用范围。因此有必要提出一种兼顾测量精度和实施测定的步长测量方法。The determination of real-time step size is of great significance. There are many studies that use wearable sensors to measure spatial parameters such as pace and stride, which are more mature, but there are not many studies on measurement steps. Some diseases such as Parkinson's syndrome can reduce the body's ability to exercise, and the pace and stride length are reduced. Therefore, the step and pace can be used to reflect the lower limbs' ability to move. However, the step and pace cannot reflect the difference in the ability of the two sides of the human body caused by hemiplegia, that is, the gait is not correct, and we can quantify the asymmetry of the gait on both sides of the human body according to the ratio of the two-leg steps, and The length can also be used to find parameters such as step size and pace, so the step size has greater clinical application value. In addition, the real-time step size can reflect the user's real-time displacement information, matching the user's real-time lower limbs. The posture information can be used for mechanical devices related to lower limb movement such as a biped robot, a lower limb assisted rehabilitation device, and the like. The use of wearable sensors to calculate step sizes has a wide range of applications. Therefore, it is necessary to propose a step size measurement method that takes into consideration the measurement accuracy and performs the measurement.
发明内容Summary of the invention
本发明的目的在于解决现有技术中步态测量精度较低、无法实时测量单步步长等缺陷,并提供一种可穿戴式设备及用于该设备的实时步长测量方法。The object of the present invention is to solve the defects in the prior art that the gait measurement accuracy is low, the single step size cannot be measured in real time, and the wearable device and the real-time step measurement method for the device are provided.
本发明中所涉及的部分名词含义如下:Some of the nouns involved in the present invention have the following meanings:
步距是指人行走过程中同一只脚相邻着地点之间的距离,步长是指人行走过程中双脚的相邻着地点之间的距离。通常来说,步距等于两腿步长之和。The step distance refers to the distance between the places where the same foot is adjacent during the walking of the person, and the step size refers to the distance between the adjacent places of the feet during the walking of the person. In general, the step size is equal to the sum of the two leg steps.
步态事件是指人在行走过程中的每个步态周期中的重要时刻,主要有摆动中期、腿伸直、脚落地、站立中期、脚离地五个步态事件。人的走路步态周期如图4所示,以右腿为例,左腿支撑人体,右腿向前迈出的这段时间为右腿的摆动相;右腿摆到左腿附近时为摆动中期;随后右腿向前踢出并伸直;接着右脚落地,右腿开始支撑人体,左腿向前迈出的这段时间,为右腿的站立相;右腿以右踝关节为旋转中心,向前移动,到达接近于与地面垂直的位置,此时为站立中期;随后右脚离地,右腿向前迈出,完成一个步态周期。Gait events refer to important moments in each gait cycle of a person during walking. There are five gait events in the middle of swing, straight legs, foot landing, middle stance, and foot off the ground. The walking gait cycle of a person is shown in Figure 4. Taking the right leg as an example, the left leg supports the human body, and the right leg takes the forward phase as the swinging phase of the right leg; when the right leg swings to the vicinity of the left leg, it swings. Mid-term; then the right leg kicks forward and straightens; then the right foot falls, the right leg begins to support the human body, the left leg takes the time forward, the right leg stands; the right leg rotates with the right ankle The center moves forward to reach a position close to the ground, at this time in the middle of the stance; then the right foot is off the ground and the right leg is taken forward to complete a gait cycle.
步态事件可以根据同侧小腿、大腿的角速度特征进行检测,如图5所示。小腿角速度在一个周期内通常主要有一高一矮的两个比较大的波峰,较高的峰对应着摆动中期,较矮的对应着站立中期;摆动中期之后有一段有很多小的负向的波峰的区域,这是脚落地造成的震动,第一个负向峰为脚落地时刻;在摆动中期与脚落地时刻之间,有一处大腿、小腿角速度相交,此刻为腿伸直时刻;在站立中期后,下一个摆动中期前,有一处波谷,此时对应着脚离地时刻。站立相从该腿脚落地开始,到脚离地结束,近似的为图中小腿角速度为负值的区域;摆动相从该腿脚离地开始,到脚落地结束,近似的为图中小腿角速度为正值的区域。Gait events can be detected based on the angular velocity characteristics of the ipsilateral calf and thigh, as shown in Figure 5. The angular velocity of the calf usually has two relatively large peaks in one cycle, one high and one short, the higher peak corresponds to the middle of the swing, the shorter one corresponds to the middle of the middle; the middle of the swing has a small number of small negative peaks. In the area, this is the vibration caused by the landing of the foot. The first negative peak is the moment of the foot landing; between the middle of the swing and the moment of the foot landing, there is a thigh, calf angular velocity intersecting, at this moment for the leg straightening moment; After the middle of the next swing, there is a trough, which corresponds to the moment when the foot is off the ground. The standing phase starts from the landing of the leg and ends, and the end of the foot is off the ground. The approximate angle is the area where the angular velocity of the lower leg is negative. The swing phase starts from the leg and ends from the ground to the end of the foot landing. The approximate angular velocity of the lower leg is positive. The area of the value.
实时步长测量是指当检测到前脚落地的步态事件时,计算该步的步长。The real-time step size measurement refers to the step size of the step when the gait event of the forefoot landing is detected.
矢状面和铅垂线如图1所示,矢状面是垂直于水平面并将人体分为左右两部分的面,人在行走时,主要运动都发生在矢状面内;铅垂线是垂直于地面的线。The sagittal plane and the plumb line are shown in Figure 1. The sagittal plane is perpendicular to the horizontal plane and divides the human body into two parts. The main movement occurs in the sagittal plane when walking. The plumb line is A line perpendicular to the ground.
另外为方便描述,定义大腿以及小腿的三维方向,如图2所示:X轴与该小腿或大腿平行;Y轴在矢状面内,与该小腿或大腿垂直;Z轴垂直于矢状面。放置 在大腿或者小腿上的传感器的坐标轴应该与该大腿或小腿保持一致,但是因为矢状面是不可见的,在安放传感器会出现Y轴、Z轴偏移的情况,根据传感器测得的Y轴、Z轴角速度可以大致计算传感器Y轴偏移矢状面的角度,并利用此角度计算该大腿或小腿的相应轴的加速度、角速度。In addition, for convenience of description, define the three-dimensional direction of the thigh and the calf, as shown in Figure 2: the X-axis is parallel to the calf or thigh; the Y-axis is in the sagittal plane, perpendicular to the calf or thigh; the Z-axis is perpendicular to the sagittal plane . Place The axis of the sensor on the thigh or calf should be consistent with the thigh or calf, but because the sagittal plane is invisible, the Y-axis and Z-axis shift will occur in the sensor, and the Y measured according to the sensor. The angular velocity of the axis and the Z-axis can roughly calculate the angle of the sagittal plane of the Y-axis of the sensor, and use this angle to calculate the acceleration and angular velocity of the corresponding axis of the thigh or the lower leg.
人体的大腿长为人体静止站立时,从髋关节到膝关节的垂直高度;小腿长为此时膝关节到地面的垂直高度。The thigh length of the human body is the vertical height from the hip joint to the knee joint when the human body stands still; the calf length is the vertical height of the knee joint to the ground at this time.
本发明为解决技术问题,所采用的具体技术方案如下:The present invention solves the technical problem, and the specific technical solutions adopted are as follows:
用于可穿戴式设备的实时步长测量方法,包括以下步骤:A real-time step size measurement method for a wearable device, including the following steps:
实时测量用户两侧大腿和小腿行走过程中的Y轴加速度和Z轴角速度,同时根据Z轴角速度实时确定行走过程中的步态事件;根据步态事件以及Z轴角速度积分实时确定大腿和小腿在矢状面内与铅垂线的夹角;再根据所述的夹角以及大腿和小腿的长度计算实时步长。步长的计算可以根据行走过程中下肢的几何学关系进行计算。The Y-axis acceleration and the Z-axis angular velocity during the walking of the thighs and calves on both sides of the user are measured in real time, and the gait events during walking are determined in real time according to the Z-axis angular velocity; the thighs and the calves are determined in real time according to the gait events and the Z-axis angular velocity integrals. The angle between the sagittal plane and the plumb line; the real-time step size is calculated based on the angle and the length of the thigh and the calf. The calculation of the step size can be calculated based on the geometric relationship of the lower limbs during walking.
作为一种优选方式,所述的可穿戴式设备中包含用于检测左右大腿和左右小腿三轴加速度、三轴角速度的传感器,所述的Y轴加速度和Z轴角速度通过传感器获得。As a preferred mode, the wearable device includes a sensor for detecting triaxial acceleration and triaxial angular velocity of the left and right thighs and the left and right calves, and the Y-axis acceleration and the Z-axis angular velocity are obtained by a sensor.
作为一种优选方式,所述的步态事件包括脚落地、站立中期以及腿伸直;In a preferred manner, the gait event includes landing of the foot, middle of standing, and straightening of the leg;
当检测到左小腿或右小腿站立中期时,计算该小腿与铅垂线的夹角(下述左小腿或右小腿的计算公式,并非同时进行计算,而是根据当前待测的目标择一选用。例如,当检测到左小腿处于站立中期,则计算θlsms;当检测到右小腿处于站立中期,则计算θrsms。后续公式也采用相同方法):When detecting the middle of the left or right calf, calculate the angle between the lower leg and the vertical line (the following formula for calculating the left or right calf is not calculated at the same time, but is selected according to the current target to be tested. For example, when it is detected that the left lower leg is in the middle of standing, θ lsms is calculated; when it is detected that the right lower leg is in the middle of standing, θ rsms is calculated. The subsequent formula also uses the same method):
Figure PCTCN2016104465-appb-000001
Figure PCTCN2016104465-appb-000001
Figure PCTCN2016104465-appb-000002
Figure PCTCN2016104465-appb-000002
式中:θlsms、θrsms分别为左小腿、右小腿在站立中期时与铅垂线的夹角,alsyms、arsyms分别为此时左小腿、右小腿Y轴加速度;其中,θl0、θr0分别为用户静态站立状态(双脚自然落地的站立状态)下的左小腿、右小腿在矢状面内与铅垂线的夹角,且满足:Where: θ lsms and θ rsms are the angles of the left lower leg and the right lower leg in the middle of the standing with the plumb line, a lsyms and a rsyms are the Y-axis accelerations of the left lower leg and the right lower leg respectively; wherein θ l0 , θ r0 is the angle between the left calf and the right calf in the sagittal plane and the plumb line in the static standing state of the user (the standing state of the feet naturally standing), and satisfies:
Figure PCTCN2016104465-appb-000003
Figure PCTCN2016104465-appb-000003
Figure PCTCN2016104465-appb-000004
Figure PCTCN2016104465-appb-000004
式中:alsys、arsys分别为用户静态站立时左小腿、右小腿Y轴加速度;Where: a lsys and a rsys are the Y-axis accelerations of the left calf and the right calf when the user is standing statically;
在检测到下一个站立中期事件之前,通过角速度积分实时计算该腿的小腿在矢状面内与铅垂线的夹角:Before the next mid-station event is detected, the angle between the calf of the leg and the plumb line in the sagittal plane is calculated in real time by angular velocity integration:
Figure PCTCN2016104465-appb-000005
Figure PCTCN2016104465-appb-000005
Figure PCTCN2016104465-appb-000006
Figure PCTCN2016104465-appb-000006
式中:t为当前时刻距离左小腿或右小腿的上一个站立中期的时间,θls(t)、θrs(t)分别为t时刻时左小腿、右小腿在矢状面内与铅垂线的夹角,ωlsz(δ)、ωrsz(δ)分别为左小腿、右小腿瞬时Z轴角速度;Where: t is the time of the last standing middle distance from the left or lower calf at the current time, θ ls (t), θ rs (t) are the left calf and the right calf in the sagittal plane and plumb at time t The angle of the line, ω lsz (δ), ω rsz (δ) are the instantaneous Z-axis angular velocity of the left lower leg and the right lower leg respectively;
由此可以实时得到两侧小腿在矢状面内与铅垂线的夹角。Thereby, the angle between the calfs on both sides in the sagittal plane and the plumb line can be obtained in real time.
当检测到左腿或右腿腿伸直时,计算该腿的大腿在矢状面内与铅垂线的夹角:When it is detected that the left leg or the right leg is straight, calculate the angle between the thigh of the leg and the plumb line in the sagittal plane:
θltls=θlsls θ ltlslsls
θrtls=θrsls θ rtls = θ rsls
式中:θltls、θrtls分别为左大腿、右大腿在腿伸直时刻在矢状面内与铅垂线的夹角,θlsls、θrsls分别为此时左小腿、右小腿在矢状面内与铅垂线的夹角; Where: θ ltls, θ rtls respectively, left thigh, right thigh at the time the legs straight in the sagittal plane and the angle between the vertical line, θ lsls, θ rsls case were left leg, right leg in the sagittal The angle between the surface and the plumb line;
在检测到下一个腿伸直事件之前,通过角速度积分实时计算该腿的大腿在矢状面内与铅垂线的夹角:Before the next leg extension event is detected, the angle between the thigh of the leg and the plumb line in the sagittal plane is calculated in real time by angular velocity integration:
Figure PCTCN2016104465-appb-000007
Figure PCTCN2016104465-appb-000007
Figure PCTCN2016104465-appb-000008
Figure PCTCN2016104465-appb-000008
式中:t为自左大腿或右大腿的上一个腿伸直时刻后的时间,θlt(t)、θrt(t)分别为t时刻时左大腿、右大腿与铅垂线的夹角,ωltz(δ)、ωrtz(δ)分别为左大腿、右大腿的瞬时Z轴角速度;Where: t is the time after the last leg of the left thigh or right thigh is straightened, θ lt (t), θ rt (t) are the angles between the left thigh, the right thigh and the plumb line at time t, respectively , ω ltz (δ), ω rtz (δ) are the instantaneous Z-axis angular velocities of the left thigh and the right thigh, respectively;
由此可以实时得到两侧大腿在矢状面内与铅垂线的夹角。Thereby, the angle between the thighs on both sides and the plumb line in the sagittal plane can be obtained in real time.
当检测到左腿或右腿脚落地时,计算该腿此时的步长:When it is detected that the left leg or the right leg is landing, calculate the step size of the leg at this time:
LSL=l1(sinθrtic+sin(-θltic))+l2(sinθrsic+sin(-θlsic)) LSL=l 1 (sinθ rtic +sin(-θ ltic ))+l 2 (sinθ rsic +sin(-θ lsic ))
RSL=l1(sin(-θrtic)+sinθltic)+2(sin(-θrsic)+sinθlsic)RSL=l 1 (sin(-θ rtic )+sinθ ltic )+ 2 (sin(-θ rsic )+sinθ lsic )
式中:θlsic、θrsic、θltic、θrtic分别为该腿落地时刻的左小腿、右小腿、左大腿、右大腿与铅垂线的夹角,l1、l2分别为大腿长、小腿长,LSL为左腿落地时刻该腿的步长,RSL为右腿落地时刻该腿的步长。Where: θ lsic , θ rsic , θ ltic , θ rtic are the angles of the left leg, the right leg, the left thigh, the right thigh and the plumb line at the time of landing of the leg, respectively, l 1 and l 2 are the thigh length, respectively. The calf is long, the LSL is the step length of the leg when the left leg is landing, and the RSL is the step length of the leg when the right leg is landing.
作为一种进一步的优选方式,测量步长之前,预先监测目标用户的一定距离内的行走过程,确定传感器Y轴实际方向偏离矢状面的角度:As a further preferred mode, before the step size is measured, the walking process within a certain distance of the target user is monitored in advance, and the angle of the actual direction of the sensor Y-axis from the sagittal plane is determined:
Figure PCTCN2016104465-appb-000009
Figure PCTCN2016104465-appb-000009
式中:
Figure PCTCN2016104465-appb-000010
为该传感器Y轴实际方向偏离矢状面的角度,
Figure PCTCN2016104465-appb-000011
为用户行走过程中在站立相时该传感器Y轴角速度的平均值,
Figure PCTCN2016104465-appb-000012
为用户行走过程中在站立相时该传感器Z轴角速度的平均值;
In the formula:
Figure PCTCN2016104465-appb-000010
The angle at which the actual direction of the Y-axis of the sensor deviates from the sagittal plane,
Figure PCTCN2016104465-appb-000011
The average value of the angular velocity of the Y-axis of the sensor during standing phase during the user's walking,
Figure PCTCN2016104465-appb-000012
The average value of the Z-axis angular velocity of the sensor when the user is standing during walking;
测量步长过程中的,每个传感器的Y轴加速度、Z轴角速度数据在代入上述各公式使用前都预先进行修正,作为该小腿或大腿相应方向的加速度或角速度,修正公式为:During the measurement of the step size, the Y-axis acceleration and Z-axis angular velocity data of each sensor are corrected in advance before being substituted into the above formulas, as the acceleration or angular velocity of the corresponding direction of the lower leg or thigh, the correction formula is:
Figure PCTCN2016104465-appb-000013
Figure PCTCN2016104465-appb-000013
Figure PCTCN2016104465-appb-000014
Figure PCTCN2016104465-appb-000014
式中:ay为该传感器测量的Y轴加速度,az为该传感器测量的Z轴加速度,ayc为该传感器的数据修正后得到的Y轴加速度;ωy为该传感器测量的Y轴角速度,ωz为该传感器测量的Z轴角速度,ωzc为该传感器的数据修正后得到的Z轴角速度。Where: a y is the Y-axis acceleration measured by the sensor, a z is the Z-axis acceleration measured by the sensor, a yc is the Y-axis acceleration obtained by correcting the data of the sensor; ω y is the Y-axis angular velocity measured by the sensor , ω z is the Z-axis angular velocity measured by the sensor, and ω zc is the Z-axis angular velocity obtained by correcting the data of the sensor.
本发明的另一目的在于提供一种步态不对称度测量方法,根据上述的方法测量实时步长,再量化单侧运动障碍的用户的步态不对称度,计算公式如下:Another object of the present invention is to provide a method for measuring gait asymmetry, which measures the real-time step size according to the above method, and then quantifies the gait asymmetry of the user with unilateral motion disorder, and the calculation formula is as follows:
Figure PCTCN2016104465-appb-000015
Figure PCTCN2016104465-appb-000015
式中:GA为步态不对称度,
Figure PCTCN2016104465-appb-000016
分别为左腿步长、右腿步长的平均值,
Figure PCTCN2016104465-appb-000017
为运动障碍一侧腿的步长。
Where: GA is gait asymmetry,
Figure PCTCN2016104465-appb-000016
The average of the left leg step and the right leg step, respectively.
Figure PCTCN2016104465-appb-000017
The step size of the leg on one side of the movement disorder.
本发明的再一目的是提供一种实现所述实时步长测量方法的可穿戴式设备,包括四个惯性传感器和上位机,每个惯性传感器包含三维加速度计以及三维角速度计,惯性传感器与上位机相连进行数据传输。It is still another object of the present invention to provide a wearable device that implements the real-time step size measuring method, including four inertial sensors and a host computer, each inertial sensor including a three-dimensional accelerometer and a three-dimensional angular velocity meter, an inertial sensor and an upper position The machine is connected for data transmission.
作为一种优选方式,所述的惯性传感器首先与单片机相连,单片机与蓝牙模 块相连,所述的上位机与所述的蓝牙模块通过蓝牙进行数据交互。As a preferred mode, the inertial sensor is first connected to a single chip microcomputer, a single chip microcomputer and a bluetooth mode. Blocks are connected, and the upper computer and the Bluetooth module exchange data through Bluetooth.
作为一种优选方式,还包括用于固定惯性传感器的固定带。As a preferred mode, a fixing strap for fixing the inertial sensor is also included.
作为一种优选方式,所述的惯性传感器为基于MPU6050芯片的惯性传感器。As a preferred mode, the inertial sensor is an inertial sensor based on the MPU6050 chip.
作为一种优选方式,所述的惯性传感器采样频率不低于100Hz。As a preferred mode, the inertial sensor sampling frequency is not less than 100 Hz.
上述各优选方式中的技术特征在不相互冲突的前提下,均可进行相互组合,不构成限制。The technical features in each of the above preferred modes can be combined with each other without conflicting each other, and are not limited.
本发明相对于现有技术而言,其有益效果是:Compared with the prior art, the invention has the following beneficial effects:
1)使用本发明计算下肢姿态、步长,廉价、方便,不受场地限制,易于推广。1) The use of the present invention to calculate the posture and step size of the lower limbs is inexpensive, convenient, and free from site restrictions, and is easy to promote.
2)使用一种基于下肢姿态的方法计算步长、量化步态不对称性,可以适应多种病态的步态,拥有较好的应用价值以及广泛的应用范围。2) Using a method based on lower limb posture to calculate step size and quantify gait asymmetry, can adapt to a variety of pathological gait, has good application value and a wide range of applications.
3)通过可穿戴式设备进行步长测量,可以方便、有效的量化人体两侧运动能力以及它们的差异,可以方便应用于临床。3) The step size measurement by the wearable device can conveniently and effectively quantify the movement ability of the human body and their differences, and can be conveniently applied to the clinic.
4)本发明可以实时输出下肢姿态以及步长,可以被用于相关设备的实时控制。4) The present invention can output the lower limb posture and the step size in real time, and can be used for real-time control of related devices.
附图说明DRAWINGS
图1本发明中矢状面、铅垂线示意图;Figure 1 is a schematic view showing a sagittal plane and a plumb line in the present invention;
图2本发明中传感器放置位置及小腿、大腿坐标系示意图;2 is a schematic view showing the position of the sensor and the coordinate system of the lower leg and the thigh in the present invention;
图3本发明中可穿戴实时步长测量系统结构图;Figure 3 is a structural diagram of a wearable real-time step size measuring system in the present invention;
图4本发明中人体行走周期示意图;Figure 4 is a schematic view showing the walking cycle of the human body in the present invention;
图5本发明中步态事件检测示意图;Figure 5 is a schematic diagram of gait event detection in the present invention;
图6本发明中脚落地时刻下肢双倒立摆二维几何模型示意图;FIG. 6 is a schematic view showing a two-dimensional geometric model of a double inverted pendulum of a lower limb in the present invention;
图7本发明中右小腿摆动中期角度标定示意图;Figure 7 is a schematic view showing the mid-angle of the right lower leg swing in the present invention;
上述图1、2、7中P表示铅垂线(Plumb line),S表示矢状面(Sagittal Plane);In the above figures 1, 2, and 7, P represents a plumb line, and S represents a sagittal plane (Sagittal Plane);
上述图2、3中,1~4分别为放置在左大腿、左小腿、右大腿、右小腿上的惯性传感器单元,5为上位机单元;In the above figures 2 and 3, 1 to 4 are inertial sensor units placed on the left thigh, the left lower leg, the right thigh, and the right lower leg, respectively, and 5 is a host computer unit;
上述图4、5中,A~E为右腿在一个步态周期内的步态事件,其中A为摆动中期步态事件,B为腿伸直步态事件,C为脚落地步态事件,D为站立中期步态事件,E为脚离地步态事件。 In Figures 4 and 5 above, A to E are gait events of the right leg in a gait cycle, where A is the mid-swing gait event, B is the leg extension gait event, and C is the foot landing gait event. D is the mid-term gait event, and E is the foot gait event.
具体实施方式detailed description
下面结合附图对本发明进行进一步说明,因便于更好地理解。本发明中的技术特征在不相互冲突的前提下,均可进行相互组合,不构成限制。The invention will be further described below in conjunction with the drawings, as it is better understood. The technical features of the present invention can be combined with each other without conflicting each other, and are not limited.
本发明使用包括四个惯性测量传感器的可穿戴设备以及一种基于几何的算法,实时计算并输出使用者在行走时的下肢姿态、步长。实时步长测量是指当检测到前脚落地的步态事件时,计算该步的步长。以某一用户为例,本发明具体实施过程如下:The present invention uses a wearable device including four inertial measurement sensors and a geometry-based algorithm to calculate and output the lower limb posture and step size of the user while walking. The real-time step size measurement refers to the step size of the step when the gait event of the forefoot landing is detected. Taking a certain user as an example, the specific implementation process of the present invention is as follows:
(1)准备工作:(1) Preparation:
本实施例中,目标用户的大腿长为42cm、小腿长为53cm,将其输入到可穿戴设备的上位机中,随后用户穿戴该可穿戴设备。In this embodiment, the target user has a thigh length of 42 cm and a calf length of 53 cm, which is input into the upper computer of the wearable device, and then the user wears the wearable device.
整套设备结构如图3所示,包含四个惯性传感器单元以及一个上位机单元。本发明中各传感器及其他电子元件的具体型号,可以根据实际需要进行选型。四个惯性传感器单元每一个都包含一个基于MPU6050芯片的惯性测量传感器模块,模块包括一个三维加速度计以及一个三维陀螺仪,用于采集使用者行走过程中的三维加速度以及三维角速度数据,采样频率为100Hz。四个传感器单元分别放置在用户的两条大腿、两条小腿外侧。定义大腿以及小腿的三维方向,如图2所示:X轴与该小腿或大腿平行;Y轴在矢状面内,与该小腿或大腿垂直;Z轴垂直于矢状面。放置在大腿或者小腿上的传感器的坐标轴应该与该大腿或小腿保持一致,以用来采集相应坐标轴的数据。小腿上的传感器单元结构上包括带弹性的固定带以MPU6050传感器模块;大腿上的传感器单元结构上包括电池、固定带、单片机、MPU6050传感器模块以及蓝牙传输模块。固定带用于将传感器单元固定在使用者腿部;大腿传感器单元中的单片机除与本单元内各模块相连外,还与身体同侧小腿传感器单元中的MPU6050传感器模块通过导线相连,用于初步处理数据;蓝牙模块用于惯性传感器单元与上位机单元通信。上位机单元结构上包括蓝牙模块、单片机、按键、电池以及OLED显示屏。单片机用于处理数据;按键及OLED显示屏构成操作界面,便于用户进行使用。The whole device structure is shown in Figure 3. It consists of four inertial sensor units and one upper unit. The specific models of the sensors and other electronic components in the present invention can be selected according to actual needs. Each of the four inertial sensor units includes an inertial measurement sensor module based on the MPU6050 chip. The module includes a three-dimensional accelerometer and a three-dimensional gyroscope for collecting three-dimensional acceleration and three-dimensional angular velocity data during the user's walking. The sampling frequency is 100Hz. The four sensor units are placed on the outside of the user's two thighs and two calves. Define the three-dimensional direction of the thigh and calf, as shown in Figure 2: the X-axis is parallel to the calf or thigh; the Y-axis is in the sagittal plane, perpendicular to the calf or thigh; the Z-axis is perpendicular to the sagittal plane. The axis of the sensor placed on the thigh or calf should be consistent with the thigh or calf to collect data for the corresponding axis. The sensor unit on the lower leg comprises an elastic fixing strap to the MPU6050 sensor module; the sensor unit on the thigh comprises a battery, a fixing strap, a single chip microcomputer, an MPU6050 sensor module and a Bluetooth transmission module. The fixing strap is used for fixing the sensor unit to the user's leg; the single-chip microcomputer in the thigh sensor unit is connected with each module in the unit, and is also connected with the MPU6050 sensor module in the same-side calf sensor unit through the wire for preliminary use. Processing data; the Bluetooth module is used for communication between the inertial sensor unit and the host unit. The upper unit structure includes a Bluetooth module, a single chip microcomputer, a button, a battery, and an OLED display. The single-chip microcomputer is used to process data; the button and the OLED display form an operation interface, which is convenient for the user to use.
由于传感器放置的位置通常不能达到标准的理想状态(X轴与该小腿或大腿平行;Y轴在矢状面内,与该小腿或大腿垂直;Z轴垂直于矢状面),传感器检测到的数据在使用前需要经过动态修正和静态标定。为了减少行走过程中传感器 震动带来的误差,需要再使用截止频率为3.2Hz的低通滤波器对修正后的Y轴加速度进行滤波,以便后面步骤使用。后续步骤需要使用传感器单元的滤波后的Y轴加速度数据、修正后的Z轴角速度数据进行步长计算。Since the position where the sensor is placed usually does not reach the standard ideal state (the X axis is parallel to the calf or thigh; the Y axis is in the sagittal plane, perpendicular to the calf or thigh; the Z axis is perpendicular to the sagittal plane), the sensor detects Data needs to be dynamically corrected and statically calibrated before use. In order to reduce the sensor during walking For the error caused by the vibration, the modified Y-axis acceleration needs to be filtered by a low-pass filter with a cutoff frequency of 3.2 Hz for later use. Subsequent steps require stepwise calculation using the filtered Y-axis acceleration data of the sensor unit and the corrected Z-axis angular velocity data.
动态修正是对大腿或者小腿上的传感器的Y轴和Z轴数据不断进行修正。在用户安放传感器时,传感器的X轴可以大致与大腿或者小腿平行,但是矢状面是不可见的,传感器放置位置容易出现偏离,较为容易造成传感器的Y轴和Z轴在它们构成的平面内偏移,因此需要确定Y轴偏离矢状面的角度
Figure PCTCN2016104465-appb-000018
动态修正具体如下:
Dynamic correction is a constant correction of the Y- and Z-axis data of the sensors on the thigh or calf. When the user places the sensor, the X axis of the sensor can be roughly parallel to the thigh or the lower leg, but the sagittal plane is invisible, the sensor placement position is prone to deviation, and the Y and Z axes of the sensor are more likely to be in the plane they form. Offset, so you need to determine the angle at which the Y axis deviates from the sagittal plane
Figure PCTCN2016104465-appb-000018
The dynamic correction is as follows:
通过预先监测用户的一定距离内的行走过程,利用传感器检测的Y轴、Z轴角速度确定传感器Y轴实际方向偏离矢状面的角度:By pre-monitoring the walking process within a certain distance of the user, the Y-axis and Z-axis angular velocity detected by the sensor are used to determine the angle of the actual Y-axis of the sensor from the sagittal plane:
Figure PCTCN2016104465-appb-000019
Figure PCTCN2016104465-appb-000019
式中:
Figure PCTCN2016104465-appb-000020
为该传感器Y轴实际方向偏离矢状面的角度,
Figure PCTCN2016104465-appb-000021
为用户行走过程中在站立相时该传感器Y轴角速度的平均值,
Figure PCTCN2016104465-appb-000022
为用户行走过程中在站立相时该传感器Z轴角速度的平均值。
In the formula:
Figure PCTCN2016104465-appb-000020
The angle at which the actual direction of the Y-axis of the sensor deviates from the sagittal plane,
Figure PCTCN2016104465-appb-000021
The average value of the angular velocity of the Y-axis of the sensor during standing phase during the user's walking,
Figure PCTCN2016104465-appb-000022
The average value of the Z-axis angular velocity of the sensor during standing phase during the user's walking.
之后,每个传感器的Y轴加速度、Z轴角速度数据在使用前都预先进行修正,作为该小腿或大腿相应方向的加速度或角速度:After that, the Y-axis acceleration and Z-axis angular velocity data of each sensor are corrected in advance before use as the acceleration or angular velocity of the calf or thigh in the corresponding direction:
Figure PCTCN2016104465-appb-000023
Figure PCTCN2016104465-appb-000023
Figure PCTCN2016104465-appb-000024
Figure PCTCN2016104465-appb-000024
式中:ay为该传感器测量的Y轴加速度,az为该传感器测量的Z轴加速度,ayc为该传感器的数据修正后得到的Y轴加速度;ωy为该传感器测量的Y轴角速度,ωz为该传感器测量的Z轴角速度,ωzc为该传感器的数据修正后得到的Z轴角速度。Where: a y is the Y-axis acceleration measured by the sensor, a z is the Z-axis acceleration measured by the sensor, a yc is the Y-axis acceleration obtained by correcting the data of the sensor; ω y is the Y-axis angular velocity measured by the sensor , ω z is the Z-axis angular velocity measured by the sensor, and ω zc is the Z-axis angular velocity obtained by correcting the data of the sensor.
静态标定是标定小腿与铅垂线夹角的零点。因为后续计算需要用到小腿与铅垂线的夹角,用户调整传感器位置后,X轴能基本保持与小腿平行,但难以达到精确平行状态,此时将X轴视为小腿的方向,将造成一定误差,因此需要重新对小腿方向进行标定。静态标定具体如下:The static calibration is to calibrate the zero point of the angle between the calf and the plumb line. Because the subsequent calculation requires the angle between the calf and the plumb line, after the user adjusts the sensor position, the X axis can be kept parallel with the calf, but it is difficult to achieve a precise parallel state. At this time, the X axis is regarded as the direction of the calf, which will cause There is a certain amount of error, so it is necessary to recalibrate the calf direction. The static calibration is as follows:
在测量步长前,还需要预先监测用户静态站立状态,并定义人体在静止站立时大腿、小腿与地面垂直,即与铅垂线夹角为0,利用重力加速度确定此状态下 的左小腿、右小腿的X轴在矢状面内分别与铅垂线的夹角:Before measuring the step size, it is also necessary to monitor the static standing state of the user in advance, and define that the thigh and the calf are perpendicular to the ground when the human body stands still, that is, the angle with the plumb line is 0, and the gravity acceleration is used to determine the state. The angle between the X-axis of the left lower leg and the right lower leg in the sagittal plane and the plumb line:
Figure PCTCN2016104465-appb-000025
Figure PCTCN2016104465-appb-000025
Figure PCTCN2016104465-appb-000026
Figure PCTCN2016104465-appb-000026
式中:θl0、θr0分别为用户静态站立状态下的左小腿、右小腿X轴在矢状面内与铅垂线的夹角,alsys、arsys分别为用户静态站立时左小腿、右小腿Y轴加速度。Where: θ l0 , θ r0 are the angle between the left calf and the right calf X axis of the user in the static standing state and the plumb line in the sagittal plane, respectively, a lsys and a rsys are the left calf of the user when standing statically, Y-axis acceleration of the right lower leg.
(2)步态事件检测:(2) gait event detection:
以上各项准备工作完成后,可以开始测量用户的步长。用户在平坦的地面上行走,四个惯性传感器实时的采集加速度、角速度数据,单片机会使用相应的算法利用这些数据进行步态事件的检测。人的走路步态周期如图4所示,一个周期中主要有摆动中期A、腿伸直B、脚落地C、站立中期D、脚离地E五个步态事件,本方法中需要检测的步态事件为脚落地、站立中期以及腿伸直。同侧的小腿与大腿的Z轴角速度可以实时的检测使用者这侧腿的每一个步态周期内的步态事件,如图5所示。脚落地事件是走路过程中前脚后落地的时刻,发生在每个步态周期内小腿角速度的最高波峰后的角速度震动区域中的第一个负值波谷处,即在最高波峰后的第一个负值转折点,并且在其发生后能够被立刻检测;站立中期为该腿作为支撑腿,移动到接近垂直与地面的位置的时刻,位于小腿角速度的较大的矮波峰处,且峰值为负值;在摆动中期与脚落地事件之间,有一处大腿角速度与小腿角速度相等的时刻,即为腿伸直事件发生的时刻,此时使用者的腿部向前进方向摆动并伸直。After the above preparations are completed, you can start measuring the user's step size. The user walks on a flat ground, and four inertial sensors collect acceleration and angular velocity data in real time. The MCU uses the corresponding algorithm to detect gait events. The walking gait cycle of a person is shown in Fig. 4. In one cycle, there are mainly five gait events of mid-swing A, leg straight B, foot landing C, standing mid-D, and foot off-E, which need to be detected in this method. The gait event is the landing of the foot, the middle of the stance, and the straightening of the legs. The Z-axis angular velocity of the calf and thigh on the same side can detect the gait event in each gait cycle of the user's side leg in real time, as shown in FIG. The foot landing event is the moment of landing before the forefoot during the walking process, occurring at the first negative trough in the angular velocity vibration region after the highest peak of the calf angular velocity in each gait cycle, that is, the first after the highest peak Negative turning point, and can be detected immediately after it occurs; the middle of the standing is the leg as the supporting leg, moving to the position close to the vertical and the ground, at the small short peak of the angular velocity of the lower leg, and the peak value is negative Between the middle of the swing and the landing event, there is a moment when the angular velocity of the thigh is equal to the angular velocity of the lower leg, that is, the moment when the leg straightening event occurs, at which time the user's leg swings and straightens in the forward direction.
(3)大腿、小腿实时角度的计算:(3) Calculation of the real-time angle of the thigh and calf:
接下来利用检测的步态事件以及角速度积分实时计算大腿、小腿在行走过程中在矢状面内与铅垂线的夹角。将人体下肢简化为双摆二维几何模型,并将用户的运动简化为矢状面内的平面运动,如图6所示,将小腿与大腿简化为杆,髋关节、两个膝关节简化为铰链。根据步骤(1)中的静态标定,人体在静止站立时大腿、小腿的简化杆模型与地面垂直,即与铅垂线夹角为0,由此可得,左、右小腿简化杆模型与该小腿X轴夹角为θl0与θr0。大腿、小腿在行走过程中与铅垂线的实时的夹角主要利用Z轴角速度实时的积分而得,但是随着积分时间的推 移,积分误差会越来越大,因此需要在每一个周期内都对其重新标定一次。对于小腿角度的标定,在站立中期时进行,如图7所示,此时脚与地面接触,小腿角速度达到极大值,角加速度近似为0,小腿达到一种稳定运动的状态,因此可以利用此时的Y轴加速度根据重力计算该小腿与铅垂线的夹角:Next, using the detected gait events and angular velocity integrals, the angle between the thigh and the calf in the sagittal plane and the plumb line during walking is calculated in real time. The lower limbs of the human body are simplified into a two-dimensional geometric model of the double pendulum, and the user's motion is simplified into a plane motion in the sagittal plane. As shown in Fig. 6, the lower leg and the thigh are simplified into a rod, and the hip joint and the two knee joints are simplified as Hinge. According to the static calibration in step (1), the simplified rod model of the thigh and the calf is perpendicular to the ground when the human body stands still, that is, the angle with the plumb line is 0, thereby obtaining the left and right calf simplified rod model and the The angle of the X-axis of the calf is θ l0 and θ r0 . The real-time angle between the thigh and the calf during the walking process and the plumb line is mainly obtained by real-time integration of the Z-axis angular velocity, but as the integration time goes on, the integral error will become larger and larger, so it needs to be in each cycle. They are recalibrated once. For the calibration of the calf angle, it is carried out in the middle of the standing, as shown in Figure 7. At this time, the foot is in contact with the ground, the angular velocity of the lower leg reaches a maximum value, the angular acceleration is approximately 0, and the calf reaches a state of stable motion, so it can be utilized. The Y-axis acceleration at this time calculates the angle between the lower leg and the vertical line according to gravity:
Figure PCTCN2016104465-appb-000027
Figure PCTCN2016104465-appb-000027
Figure PCTCN2016104465-appb-000028
Figure PCTCN2016104465-appb-000028
式中:θlsms、θrsms分别为左小腿、右小腿在站立中期时与铅垂线的夹角,alsyms、arsyms分别为此时经截止频率3.2Hz的低通滤波器修正后的的左小腿、右小腿Y轴加速度。Where: θ lsms and θ rsms are the angles between the left lower leg and the right lower leg in the middle of the standing and the vertical line, a lsyms and a rsyms are respectively corrected by a low-pass filter with a cutoff frequency of 3.2 Hz. Y-axis acceleration of the left calf and right calf.
在检测到下一个站立中期事件之前,实时的左小腿、右小腿与铅垂线的夹角以上一个站立中期标定的夹角为起点,通过角速度积分计算:Before the next mid-station event is detected, the angle between the real left left leg, the right calf and the plumb line above the angle of the standing mid-point calibration is taken as the starting point, calculated by the angular velocity integral:
Figure PCTCN2016104465-appb-000029
Figure PCTCN2016104465-appb-000029
Figure PCTCN2016104465-appb-000030
Figure PCTCN2016104465-appb-000030
式中:t为自左小腿或右小腿的上一个站立中期后的时间,θls(t)、θrs(t)分别为t时刻时左小腿、右小腿与铅垂线的夹角,ωlsz(δ)、ωrsz(δ)为左小腿、右小腿瞬时Z轴角速度。Where: t is the time from the middle of the left or lower calf, θ ls (t), θ rs (t) are the angles between the left calf, the right calf and the plumb line at time t, ω Lsz (δ), ω rsz (δ) is the instantaneous Z-axis angular velocity of the left lower leg and the right lower leg.
然后是大腿角度的标定,当检测到左腿或右腿腿伸直时,大腿小腿近似处于一条直线上,以此计算该腿的大腿与铅垂线的夹角。Then there is the calibration of the thigh angle. When it is detected that the left leg or the right leg is straight, the thigh calf is approximately in a straight line, thereby calculating the angle between the thigh and the plumb line of the leg.
θltls=θlsls θ ltlslsls
θrtls=θrsls θ rtls = θ rsls
式中:θltls、θrtls分别为左大腿、右大腿在腿伸直时刻与铅垂线的夹角,θlsls、θrsls分别为此时左大腿、右大腿与铅垂线的夹角。 Where: θ ltls, θ rtls respectively, left thigh, right thigh of the leg straight line time and the vertical angle, θ lsls, θ rsls respectively, left thigh angle At this time, the vertical lines of the right thigh.
在检测到下一个腿伸直事件之前,实时的左大腿、右大腿与铅垂线的夹角通过角速度积分计算:The angle between the real left thigh, the right thigh and the plumb line is calculated by the angular velocity integral before the next leg extension event is detected:
Figure PCTCN2016104465-appb-000031
Figure PCTCN2016104465-appb-000031
Figure PCTCN2016104465-appb-000032
Figure PCTCN2016104465-appb-000032
式中:t为自左大腿或右大腿的上一个腿伸直时刻后的时间,θlt(t)、θrt(t)分别为t时刻时左大腿、右大腿与铅垂线的夹角,ωltz(δ)、ωrtz(δ)为左大腿、右大腿的瞬时Z轴角速度。Where: t is the time after the last leg of the left thigh or right thigh is straightened, θ lt (t), θ rt (t) are the angles between the left thigh, the right thigh and the plumb line at time t, respectively , ω ltz (δ), ω rtz (δ) are the instantaneous Z-axis angular velocities of the left thigh and the right thigh.
(4)步长的计算:(4) Calculation of the step size:
以上步骤中的计算主要在大腿惯性传感器单元中的单片机内完成,随后通过蓝牙将步态事件实时检测的结果以及大腿、小腿的实时角度发送给上位机单元。The calculation in the above steps is mainly completed in the single-chip microcomputer in the thigh inertial sensor unit, and then the result of the real-time detection of the gait event and the real-time angle of the thigh and the calf are transmitted to the upper computer unit through Bluetooth.
当检测到左腿或右腿的脚落地事件时,上位机通过如图6所示的几何模型的实时计算用户该腿该步的步长:When the foot landing event of the left leg or the right leg is detected, the host computer calculates the step size of the user's leg by real-time calculation of the geometric model as shown in FIG. 6:
LSL=l1(sinθrtic+sin(-θltic))+l2(sinθrsic+sin(-θlsic))LSL=l 1 (sinθ rtic +sin(-θ ltic ))+l 2 (sinθ rsic +sin(-θ lsic ))
RSL=l1(sin(-θrtic)+sinθltic)+2(sin(-θrsic)+sinθlsic)RSL=l 1 (sin(-θ rtic )+sinθ ltic )+ 2 (sin(-θ rsic )+sinθ lsic )
式中:θlsic、θrsic、θltic、θrtic分别为步骤(3)计算的在该腿的脚落地时刻的左小腿、右小腿、左大腿、右大腿与铅垂线的夹角,l1、l2分别为大腿长、小腿长,LSL为左腿落地时刻该腿的步长,RSL为右腿落地时刻该腿的步长。Where: θ lsic , θ rsic , θ ltic , θ rtic are the angles of the left calf, the right calf, the left thigh, the right thigh and the plumb line at the time of landing of the leg of the leg calculated in step (3), respectively. 1 and l 2 are the length of the thigh and the length of the calf, respectively. The LSL is the step length of the leg when the left leg is landing, and the RSL is the step length of the leg when the right leg is landing.
计算的步长结果可以直接实时的显示在OLED显示屏上,也可以通过串口发送至其他设备中。The calculated step size results can be displayed directly on the OLED display in real time or sent to other devices via the serial port.
测量过程中,用户的每一步的步长都通过上述方式测量。在用户结束步行后,如果该用户单侧下肢有运动障碍,还可以量化该用户的步态不对称度:During the measurement process, the step size of each step of the user is measured by the above method. After the user finishes walking, if the user has dyskinesia on one side of the lower limb, the gait asymmetry of the user can also be quantified:
Figure PCTCN2016104465-appb-000033
Figure PCTCN2016104465-appb-000033
式中:GA为步态不对称度,
Figure PCTCN2016104465-appb-000034
分别为左腿步长、右腿步长的平均值,
Figure PCTCN2016104465-appb-000035
为运动障碍一侧腿的平均步长。
Where: GA is gait asymmetry,
Figure PCTCN2016104465-appb-000034
The average of the left leg step and the right leg step, respectively.
Figure PCTCN2016104465-appb-000035
The average step size of the leg on one side of the dyskinesia.
(5)步长测量效果:(5) Step measurement effect:
本例中用户无下肢运动障碍,在步长测量过程中一共行走了22步,每一步均能够被实时的检测的并实时的计算步长。通过与每一步的步长的实际值对比,该过程测量的所有步长的均方根误差为3.9cm,为该用户实际平均步长(63.1cm)的6.2%;假定该用户左腿为运动障碍的一侧,其步态不对称度实际值为0.503,该过程的测量值为0.508,误差为0.005。由此可见,本发明的装置和方法相对于现有技术而言,不仅能够实现实时的步长和步态不对称度的测量,而且其实际精 度也得到了大大地提高。In this example, the user has no lower extremity dyskinesia. In the step measurement process, a total of 22 steps are taken. Each step can be detected in real time and the step size is calculated in real time. By comparing the actual value of the step size of each step, the root mean square error of all steps measured by the process is 3.9 cm, which is 6.2% of the user's actual average step size (63.1 cm); it is assumed that the user's left leg is motion On one side of the obstacle, the actual gait asymmetry is 0.503, and the measured value of the process is 0.508 with an error of 0.005. It can be seen that the device and method of the present invention can not only realize real-time measurement of step size and gait asymmetry, but also actual precision thereof. The degree has also been greatly improved.
以上所述的实施例只是本发明的一些较佳的方案,然而其并非用以限制本发明。有关技术领域的普通技术人员,在不脱离本发明的精神和范围的情况下,还可以做出各种变化和变型。例如,上述实施例也可以使用其他算法或者使用其他传感器来实时计算大腿、小腿的角度,如使用加速度计、陀螺仪、磁场传感器融合进行卡尔曼滤波算法计算左、右侧大腿、小腿的角度,进而利用如图6的几何模型进行步长计算。而上述可穿戴设备也可以采用现有技术中的其他结构或对附图中展示的设备进行改动,如去除原设备中的有线连接,四个惯性传感器全都通过无线通讯,以更方便地使用。单片机也可以集成于上位机单元中。上位机单元也可以采用远程的PC机等形式。另外,在被本发明的方法中,在传感器安装角度和位置准确的情况下,还可以省略对放置在腿上的传感器采集的数据进行校正的步骤,直接将传感器数据用于步长测量的过程。The embodiments described above are only some of the preferred embodiments of the present invention, but are not intended to limit the present invention. Various changes and modifications can be made by those skilled in the art without departing from the spirit and scope of the invention. For example, the above embodiment may also use other algorithms or use other sensors to calculate the angle of the thigh and the calf in real time, such as using an accelerometer, a gyroscope, and a magnetic field sensor fusion to calculate the angles of the left and right thighs and the calves by using a Kalman filter algorithm. The step size calculation is further performed using the geometric model of FIG. 6. The above-mentioned wearable device may also adopt other structures in the prior art or modify the device shown in the drawing. For example, the wired connection in the original device is removed, and all the four inertial sensors are wirelessly communicated for more convenient use. The single chip microcomputer can also be integrated in the upper computer unit. The host computer unit can also be in the form of a remote PC or the like. In addition, in the method of the present invention, in the case where the sensor mounting angle and position are accurate, the step of correcting the data collected by the sensor placed on the leg may be omitted, and the sensor data is directly used for the step length measurement process. .
由此可见,凡采取等同替换或等效变换的方式所获得的技术方案,均落在本发明的保护范围内。 It can be seen that the technical solutions obtained by adopting the equivalent replacement or equivalent transformation are all within the protection scope of the present invention.

Claims (10)

  1. 一种用于可穿戴式设备的实时步长测量方法,其特征在于,包括以下步骤:实时测量用户两侧大腿和小腿行走过程中的Y轴加速度和Z轴角速度,同时根据Z轴角速度实时确定行走过程中的步态事件;根据步态事件以及Z轴角速度积分实时确定大腿和小腿在矢状面内与铅垂线的夹角;再根据所述的夹角以及大腿和小腿的长度计算实时步长。A real-time step size measuring method for a wearable device, comprising the steps of: measuring a Y-axis acceleration and a Z-axis angular velocity during walking of a thigh and a calf on both sides of a user in real time, and determining in real time according to the Z-axis angular velocity Gait events during walking; the angle between the thigh and the calf in the sagittal plane and the plumb line is determined in real time according to the gait event and the Z-axis angular velocity integral; and the real time is calculated according to the angle and the length of the thigh and the calf. Step size.
  2. 如权利要求1所述的用于可穿戴式设备的实时步长测量方法,其特征在于,所述的可穿戴式设备中包含用于检测左右大腿和左右小腿三轴加速度、三轴角速度的传感器,所述的Y轴加速度和Z轴角速度通过传感器获得。The real-time step size measuring method for a wearable device according to claim 1, wherein the wearable device includes a sensor for detecting three-axis acceleration and three-axis angular velocity of the left and right thighs and the left and right lower legs. The Y-axis acceleration and the Z-axis angular velocity are obtained by a sensor.
  3. 如权利要求1所述的用于可穿戴式设备的实时步长测量方法,其特征在于,所述的步态事件包括脚落地、站立中期以及腿伸直;The method for measuring a real-time step size for a wearable device according to claim 1, wherein the gait event comprises a foot landing, a middle standing, and a leg straightening;
    当检测到左小腿或右小腿站立中期时,计算该小腿与铅垂线的夹角:When the middle of the left or right calf is detected, the angle between the lower leg and the plumb line is calculated:
    Figure PCTCN2016104465-appb-100001
    Figure PCTCN2016104465-appb-100001
    Figure PCTCN2016104465-appb-100002
    Figure PCTCN2016104465-appb-100002
    式中:θlsms、θrsms分别为左小腿、右小腿在站立中期时与铅垂线的夹角,alsyms、arsyms分别为此时左小腿、右小腿Y轴加速度;其中,θl0、θr0分别为用户静态站立状态下的左小腿、右小腿在矢状面内与铅垂线的夹角,且满足:Where: θ lsms and θ rsms are the angles of the left lower leg and the right lower leg in the middle of the standing with the plumb line, a lsyms and a rsyms are the Y-axis accelerations of the left lower leg and the right lower leg respectively; wherein θ l0 , θ r0 is the angle between the left lower leg and the right lower leg in the sagittal plane and the plumb line in the static standing state of the user, and satisfies:
    Figure PCTCN2016104465-appb-100003
    Figure PCTCN2016104465-appb-100003
    Figure PCTCN2016104465-appb-100004
    Figure PCTCN2016104465-appb-100004
    式中:alsys、arsys分别为用户静态站立时左小腿、右小腿Y轴加速度;Where: a lsys and a rsys are the Y-axis accelerations of the left calf and the right calf when the user is standing statically;
    在检测到下一个站立中期事件之前,通过角速度积分实时计算该腿的小腿在矢状面内与铅垂线的夹角:Before the next mid-station event is detected, the angle between the calf of the leg and the plumb line in the sagittal plane is calculated in real time by angular velocity integration:
    Figure PCTCN2016104465-appb-100005
    Figure PCTCN2016104465-appb-100005
    Figure PCTCN2016104465-appb-100006
    Figure PCTCN2016104465-appb-100006
    式中:t为当前时刻距离左小腿或右小腿的上一个站立中期的时间,θls(t)、θrs(t)分别为t时刻时左小腿、右小腿在矢状面内与铅垂线的夹角,ωlsz(δ)、ωrsz(δ)分别为左小腿、右小腿瞬时Z轴角速度;Where: t is the time of the last standing middle distance from the left or lower calf at the current time, θ ls (t), θ rs (t) are the left calf and the right calf in the sagittal plane and plumb at time t The angle of the line, ω lsz (δ), ω rsz (δ) are the instantaneous Z-axis angular velocity of the left lower leg and the right lower leg respectively;
    当检测到左腿或右腿腿伸直时,计算该腿的大腿在矢状面内与铅垂线的夹角:When it is detected that the left leg or the right leg is straight, calculate the angle between the thigh of the leg and the plumb line in the sagittal plane:
    θltls=θlsls θ ltlslsls
    θrtls=θrsls θ rtls = θ rsls
    式中:θltls、θrtls分别为左大腿、右大腿在腿伸直时刻在矢状面内与铅垂线的夹角,θlsls、θrsls分别为此时左小腿、右小腿在矢状面内与铅垂线的夹角; Where: θ ltls, θ rtls respectively, left thigh, right thigh at the time the legs straight in the sagittal plane and the angle between the vertical line, θ lsls, θ rsls case were left leg, right leg in the sagittal The angle between the surface and the plumb line;
    在检测到下一个腿伸直事件之前,通过角速度积分实时计算该腿的大腿在矢状面内与铅垂线的夹角:Before the next leg extension event is detected, the angle between the thigh of the leg and the plumb line in the sagittal plane is calculated in real time by angular velocity integration:
    Figure PCTCN2016104465-appb-100007
    Figure PCTCN2016104465-appb-100007
    Figure PCTCN2016104465-appb-100008
    Figure PCTCN2016104465-appb-100008
    式中:t为自左大腿或右大腿的上一个腿伸直时刻后的时间,θlt(t)、θrt(t)分别为t时刻时左大腿、右大腿与铅垂线的夹角,ωltz(δ)、ωrtz(δ)分别为左大腿、右大腿的瞬时Z轴角速度;Where: t is the time after the last leg of the left thigh or right thigh is straightened, θ lt (t), θ rt (t) are the angles between the left thigh, the right thigh and the plumb line at time t, respectively , ω ltz (δ), ω rtz (δ) are the instantaneous Z-axis angular velocities of the left thigh and the right thigh, respectively;
    当检测到左腿或右腿脚落地时,计算该腿此时的步长:When it is detected that the left leg or the right leg is landing, calculate the step size of the leg at this time:
    LSL=l1(sinθrtic+sin(-θltic))+l2(sinθrsic+sin(-θlsic))LSL=l 1 (sinθ rtic +sin(-θ ltic ))+l 2 (sinθ rsic +sin(-θ lsic ))
    RSL=l1(sin(-θrtic)+sinθltic)+l2(sin(-θrsic)+sinθlsic)RSL=l 1 (sin(-θ rtic )+sinθ ltic )+l 2 (sin(-θ rsic )+sinθ lsic )
    式中:θlsic、θrsic、θltic、θrtic分别为该腿落地时刻的左小腿、右小腿、左大腿、右大腿与铅垂线的夹角,l1、l2分别为大腿长、小腿长,LSL为左腿落地时刻该腿的步长,RSL为右腿落地时刻该腿的步长。Where: θ lsic , θ rsic , θ ltic , θ rtic are the angles of the left leg, the right leg, the left thigh, the right thigh and the plumb line at the time of landing of the leg, respectively, l 1 and l 2 are the thigh length, respectively. The calf is long, the LSL is the step length of the leg when the left leg is landing, and the RSL is the step length of the leg when the right leg is landing.
  4. 如权利要求2所述的用于可穿戴式设备的实时步长测量方法,其特征在于,测量步长之前,预先监测目标用户的一定距离内的行走过程,确定传感器Y轴实际方向偏离矢状面的角度:The real-time step size measuring method for a wearable device according to claim 2, wherein before the step size is measured, the walking process within a certain distance of the target user is monitored in advance, and the actual direction of the sensor Y-axis is determined to be sagittal. Face angle:
    Figure PCTCN2016104465-appb-100009
    Figure PCTCN2016104465-appb-100009
    式中:
    Figure PCTCN2016104465-appb-100010
    为该传感器Y轴实际方向偏离矢状面的角度,
    Figure PCTCN2016104465-appb-100011
    为用户行走过程中在站立相时该传感器Y轴角速度的平均值,
    Figure PCTCN2016104465-appb-100012
    为用户行走过程中在站立相时 该传感器Z轴角速度的平均值;
    In the formula:
    Figure PCTCN2016104465-appb-100010
    The angle at which the actual direction of the Y-axis of the sensor deviates from the sagittal plane,
    Figure PCTCN2016104465-appb-100011
    The average value of the angular velocity of the Y-axis of the sensor during standing phase during the user's walking,
    Figure PCTCN2016104465-appb-100012
    The average value of the Z-axis angular velocity of the sensor when the user is standing during walking;
    测量步长过程中的,每个传感器的Y轴加速度、Z轴角速度数据在使用前都预先进行修正,作为该小腿或大腿相应方向的加速度或角速度,修正公式为:During the measurement of the step size, the Y-axis acceleration and Z-axis angular velocity data of each sensor are corrected in advance before use as the acceleration or angular velocity of the corresponding direction of the lower leg or thigh. The correction formula is:
    Figure PCTCN2016104465-appb-100013
    Figure PCTCN2016104465-appb-100013
    式中:ay为该传感器测量的Y轴加速度,az为该传感器测量的Z轴加速度,ayc为该传感器的数据修正后得到的Y轴加速度;ωy为该传感器测量的Y轴角速度,ωz为该传感器测量的Z轴角速度,ωzc为该传感器的数据修正后得到的Z轴角速度。Where: a y is the Y-axis acceleration measured by the sensor, a z is the Z-axis acceleration measured by the sensor, a yc is the Y-axis acceleration obtained by correcting the data of the sensor; ω y is the Y-axis angular velocity measured by the sensor , ω z is the Z-axis angular velocity measured by the sensor, and ω zc is the Z-axis angular velocity obtained by correcting the data of the sensor.
  5. 一种步态不对称度测量方法,其特征在于,根据权利要求1所述的方法测量实时步长,再量化单侧运动障碍的用户的步态不对称度:A method for measuring gait asymmetry, characterized in that the method according to claim 1 measures the real-time step size and then quantifies the gait asymmetry of the user with unilateral dyskinesia:
    Figure PCTCN2016104465-appb-100014
    Figure PCTCN2016104465-appb-100014
    式中:GA为步态不对称度,
    Figure PCTCN2016104465-appb-100015
    分别为左腿步长、右腿步长的平均值,
    Figure PCTCN2016104465-appb-100016
    为运动障碍一侧腿的步长。
    Where: GA is gait asymmetry,
    Figure PCTCN2016104465-appb-100015
    The average of the left leg step and the right leg step, respectively.
    Figure PCTCN2016104465-appb-100016
    The step size of the leg on one side of the movement disorder.
  6. 一种实现权利要求1所述实时步长测量方法的可穿戴式设备,其特征在于,包括四个惯性传感器和上位机,每个惯性传感器包含三维加速度计以及三维角速度计,惯性传感器与上位机相连进行数据传输。A wearable device for realizing the real-time step measurement method according to claim 1, comprising four inertial sensors and a host computer, each inertial sensor comprising a three-dimensional accelerometer and a three-dimensional angular velocity meter, an inertial sensor and a host computer Connected for data transmission.
  7. 如权利要求6所述的可穿戴式设备,其特征在于,所述的惯性传感器首先与单片机相连,单片机与蓝牙模块相连,所述的上位机与所述的蓝牙模块通过蓝牙进行数据交互。The wearable device according to claim 6, wherein the inertial sensor is first connected to the single chip microcomputer, and the single chip microcomputer is connected to the bluetooth module, and the upper computer and the bluetooth module exchange data through Bluetooth.
  8. 如权利要求6所述的可穿戴式设备,其特征在于,还包括用于固定惯性传感器的固定带。The wearable device of claim 6 further comprising a securing strap for securing the inertial sensor.
  9. 如权利要求6所述的可穿戴式设备,其特征在于,所述的惯性传感器为基于MPU6050芯片的惯性传感器。The wearable device according to claim 6, wherein said inertial sensor is an inertial sensor based on an MPU6050 chip.
  10. 如权利要求6所述的可穿戴式设备,其特征在于,所述的惯性传感器采样频率不低于100Hz。 The wearable device according to claim 6, wherein said inertial sensor sampling frequency is not less than 100 Hz.
PCT/CN2016/104465 2016-11-03 2016-11-03 Wearable device and real-time step length measurement method for device WO2018081986A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2016/104465 WO2018081986A1 (en) 2016-11-03 2016-11-03 Wearable device and real-time step length measurement method for device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2016/104465 WO2018081986A1 (en) 2016-11-03 2016-11-03 Wearable device and real-time step length measurement method for device

Publications (1)

Publication Number Publication Date
WO2018081986A1 true WO2018081986A1 (en) 2018-05-11

Family

ID=62076471

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2016/104465 WO2018081986A1 (en) 2016-11-03 2016-11-03 Wearable device and real-time step length measurement method for device

Country Status (1)

Country Link
WO (1) WO2018081986A1 (en)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109540133A (en) * 2018-09-29 2019-03-29 中国科学院自动化研究所 Adaptive gait division methods, system based on micro- inertial technology
CN110680335A (en) * 2019-10-08 2020-01-14 深圳市臻络科技有限公司 Step length measuring method and device, system and non-volatile computer storage medium thereof
CN111967366A (en) * 2020-08-12 2020-11-20 华中科技大学鄂州工业技术研究院 Method for evaluating rehabilitation condition of leg patient and walking-aid robot
CN112066980A (en) * 2020-08-31 2020-12-11 南京航空航天大学 Pedestrian navigation positioning method based on human body four-node motion constraint
CN112949676A (en) * 2020-12-29 2021-06-11 武汉理工大学 Self-adaptive motion mode identification method of flexible lower limb assistance exoskeleton robot
CN113317776A (en) * 2020-12-29 2021-08-31 武汉理工大学 Gait phase detection method for exoskeleton without plantar pressure in multiple motion modes
CN113768760A (en) * 2021-09-08 2021-12-10 中国科学院深圳先进技术研究院 Control method and system of walking aid and driving device
CN113995634A (en) * 2021-12-08 2022-02-01 广州龙之杰科技有限公司 Limb rehabilitation training device and symmetry parameter acquisition method and device thereof
CN114190921A (en) * 2020-09-02 2022-03-18 中国科学院沈阳自动化研究所 Gait phase recognition method capable of adapting to variable step frequency walking
CN114587346A (en) * 2022-03-25 2022-06-07 中电海康集团有限公司 Human body lower limb movement monitoring method and system based on IMU

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101694499A (en) * 2009-10-22 2010-04-14 浙江大学 Pedestrian gait detection-based system and method of walking speed measurement and transmission
CN102670217A (en) * 2012-05-04 2012-09-19 嘉兴市制衡精仪有限公司 Wearable sensor measuring device and method for lower limb joint acting force and moment
CN103267524A (en) * 2013-04-24 2013-08-28 华中科技大学 Wearable personnel gait-detection indoor-positioning system and method therefor
CN104757976A (en) * 2015-04-16 2015-07-08 大连理工大学 Human gait analyzing method and system based on multi-sensor fusion
US20160284231A1 (en) * 2015-03-26 2016-09-29 President And Fellows Of Harvard College Systems and Methods for Detecting Overstriding in Runners
CN106419928A (en) * 2016-11-03 2017-02-22 浙江大学 Portable device and method oriented for device for real-time measuring of step length

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101694499A (en) * 2009-10-22 2010-04-14 浙江大学 Pedestrian gait detection-based system and method of walking speed measurement and transmission
CN102670217A (en) * 2012-05-04 2012-09-19 嘉兴市制衡精仪有限公司 Wearable sensor measuring device and method for lower limb joint acting force and moment
CN103267524A (en) * 2013-04-24 2013-08-28 华中科技大学 Wearable personnel gait-detection indoor-positioning system and method therefor
US20160284231A1 (en) * 2015-03-26 2016-09-29 President And Fellows Of Harvard College Systems and Methods for Detecting Overstriding in Runners
CN104757976A (en) * 2015-04-16 2015-07-08 大连理工大学 Human gait analyzing method and system based on multi-sensor fusion
CN106419928A (en) * 2016-11-03 2017-02-22 浙江大学 Portable device and method oriented for device for real-time measuring of step length

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109540133A (en) * 2018-09-29 2019-03-29 中国科学院自动化研究所 Adaptive gait division methods, system based on micro- inertial technology
CN110680335A (en) * 2019-10-08 2020-01-14 深圳市臻络科技有限公司 Step length measuring method and device, system and non-volatile computer storage medium thereof
CN111967366A (en) * 2020-08-12 2020-11-20 华中科技大学鄂州工业技术研究院 Method for evaluating rehabilitation condition of leg patient and walking-aid robot
CN111967366B (en) * 2020-08-12 2022-10-21 华中科技大学鄂州工业技术研究院 Method for evaluating rehabilitation condition of leg patient and walking-aid robot
CN112066980A (en) * 2020-08-31 2020-12-11 南京航空航天大学 Pedestrian navigation positioning method based on human body four-node motion constraint
CN114190921A (en) * 2020-09-02 2022-03-18 中国科学院沈阳自动化研究所 Gait phase recognition method capable of adapting to variable step frequency walking
CN114190921B (en) * 2020-09-02 2024-05-17 中国科学院沈阳自动化研究所 Gait phase identification method capable of adapting to variable-step-frequency walking
CN112949676A (en) * 2020-12-29 2021-06-11 武汉理工大学 Self-adaptive motion mode identification method of flexible lower limb assistance exoskeleton robot
CN112949676B (en) * 2020-12-29 2022-07-08 武汉理工大学 Self-adaptive motion mode identification method of flexible lower limb assistance exoskeleton robot
CN113317776B (en) * 2020-12-29 2023-04-07 武汉理工大学 Gait phase detection method for exoskeleton without plantar pressure in multiple motion modes
CN113317776A (en) * 2020-12-29 2021-08-31 武汉理工大学 Gait phase detection method for exoskeleton without plantar pressure in multiple motion modes
CN113768760A (en) * 2021-09-08 2021-12-10 中国科学院深圳先进技术研究院 Control method and system of walking aid and driving device
CN113768760B (en) * 2021-09-08 2022-12-20 中国科学院深圳先进技术研究院 Control method and system of walking aid and driving device
WO2023035457A1 (en) * 2021-09-08 2023-03-16 中国科学院深圳先进技术研究院 Walking aid control method and system, and driving device
CN113995634A (en) * 2021-12-08 2022-02-01 广州龙之杰科技有限公司 Limb rehabilitation training device and symmetry parameter acquisition method and device thereof
CN113995634B (en) * 2021-12-08 2024-04-12 广州龙之杰科技有限公司 Limb rehabilitation training device and symmetry parameter acquisition method and device thereof
CN114587346A (en) * 2022-03-25 2022-06-07 中电海康集团有限公司 Human body lower limb movement monitoring method and system based on IMU

Similar Documents

Publication Publication Date Title
WO2018081986A1 (en) Wearable device and real-time step length measurement method for device
CN106419928B (en) A kind of wearable device and the real-time step-length measuring method for the equipment
WO2018132999A1 (en) Human body step length measuring method for use in wearable device and measuring device of the method
Wang et al. Estimation of step length and gait asymmetry using wearable inertial sensors
KR101751760B1 (en) Method for estimating gait parameter form low limb joint angles
CN104757976B (en) A kind of Human Body Gait Analysis method and system based on Multi-sensor Fusion
WO2018196227A1 (en) Evaluation method, device, and system for human motor capacity
WO2017014294A1 (en) Gait analysis method and gait analysis system
CN106908021A (en) A kind of human-step length measuring method and its measuring apparatus for Wearable device
Li et al. The lower limbs kinematics analysis by wearable sensor shoes
Huang et al. Novel foot progression angle algorithm estimation via foot-worn, magneto-inertial sensing
Liu et al. Triaxial joint moment estimation using a wearable three-dimensional gait analysis system
Tumkur et al. Modeling human walking for step detection and stride determination by 3-axis accelerometer readings in pedometer
CN107137089A (en) A kind of Wearable sensing shoe system and gait evaluation method
KR20110064712A (en) Motion capture system using integrated sensor system
CN111012358B (en) Human ankle joint motion trajectory measurement method and wearable device
CN111895997B (en) Human body action acquisition method based on inertial sensor without standard posture correction
Tan et al. Magnetometer-free, IMU-based foot progression angle estimation for real-life walking conditions
CN110609621A (en) Posture calibration method and human motion capture system based on micro-sensor
CN110680335A (en) Step length measuring method and device, system and non-volatile computer storage medium thereof
CN202932930U (en) Wearable sensor measurement device for acting forces and moments related to lower limb joints of human body
CN108309301B (en) Human body segment quality measuring method
Hu et al. A study on estimation of planar gait kinematics using minimal inertial measurement units and inverse kinematics
CN109945889A (en) A kind of joint angles measurement method based on double attitude transducers
Li et al. Wearable gait analysis system for ambulatory measurement of kinematics and kinetics

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: 16920522

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 16920522

Country of ref document: EP

Kind code of ref document: A1

32PN Ep: public notification in the ep bulletin as address of the adressee cannot be established

Free format text: NOTING OF LOSS OF RIGHTS PURSUANT TO RULE 112(1) EPC (EPO FORM 1205 DATED 20.11.2019)

122 Ep: pct application non-entry in european phase

Ref document number: 16920522

Country of ref document: EP

Kind code of ref document: A1