CN108187333A - More inertia node wireless monitoring and evaluation system and methods in rehabilitation training of upper limbs - Google Patents

More inertia node wireless monitoring and evaluation system and methods in rehabilitation training of upper limbs Download PDF

Info

Publication number
CN108187333A
CN108187333A CN201810082314.9A CN201810082314A CN108187333A CN 108187333 A CN108187333 A CN 108187333A CN 201810082314 A CN201810082314 A CN 201810082314A CN 108187333 A CN108187333 A CN 108187333A
Authority
CN
China
Prior art keywords
node
data
arm
mode
rehabilitation training
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201810082314.9A
Other languages
Chinese (zh)
Inventor
徐国政
徐雷
谭彩铭
巩伟杰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Post and Telecommunication University
Original Assignee
Nanjing Post and Telecommunication University
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 Nanjing Post and Telecommunication University filed Critical Nanjing Post and Telecommunication University
Priority to CN201810082314.9A priority Critical patent/CN108187333A/en
Publication of CN108187333A publication Critical patent/CN108187333A/en
Pending legal-status Critical Current

Links

Classifications

    • AHUMAN NECESSITIES
    • A63SPORTS; GAMES; AMUSEMENTS
    • A63BAPPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B71/00Games or sports accessories not covered in groups A63B1/00 - A63B69/00
    • A63B71/06Indicating or scoring devices for games or players, or for other sports activities
    • A63B71/0619Displays, user interfaces and indicating devices, specially adapted for sport equipment, e.g. display mounted on treadmills
    • 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
    • A61B5/1121Determining geometric values, e.g. centre of rotation or angular range of movement
    • A61B5/1122Determining geometric values, e.g. centre of rotation or angular range of movement of movement trajectories
    • 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
    • A61B5/1126Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb using a particular sensing technique
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04LTRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L67/00Network arrangements or protocols for supporting network services or applications
    • H04L67/01Protocols
    • H04L67/12Protocols specially adapted for proprietary or special-purpose networking environments, e.g. medical networks, sensor networks, networks in vehicles or remote metering networks
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W84/00Network topologies
    • H04W84/18Self-organising networks, e.g. ad-hoc networks or sensor networks
    • AHUMAN NECESSITIES
    • A63SPORTS; GAMES; AMUSEMENTS
    • A63BAPPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B2220/00Measuring of physical parameters relating to sporting activity
    • A63B2220/80Special sensors, transducers or devices therefor
    • A63B2220/803Motion sensors
    • AHUMAN NECESSITIES
    • A63SPORTS; GAMES; AMUSEMENTS
    • A63BAPPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B2220/00Measuring of physical parameters relating to sporting activity
    • A63B2220/80Special sensors, transducers or devices therefor
    • A63B2220/83Special sensors, transducers or devices therefor characterised by the position of the sensor
    • A63B2220/836Sensors arranged on the body of the user
    • AHUMAN NECESSITIES
    • A63SPORTS; GAMES; AMUSEMENTS
    • A63BAPPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B2225/00Miscellaneous features of sport apparatus, devices or equipment
    • A63B2225/50Wireless data transmission, e.g. by radio transmitters or telemetry
    • AHUMAN NECESSITIES
    • A63SPORTS; GAMES; AMUSEMENTS
    • A63BAPPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
    • A63B2230/00Measuring physiological parameters of the user
    • A63B2230/62Measuring physiological parameters of the user posture

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • General Health & Medical Sciences (AREA)
  • Medical Informatics (AREA)
  • Physics & Mathematics (AREA)
  • Animal Behavior & Ethology (AREA)
  • Public Health (AREA)
  • Dentistry (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Signal Processing (AREA)
  • Biophysics (AREA)
  • Pathology (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Molecular Biology (AREA)
  • Surgery (AREA)
  • Veterinary Medicine (AREA)
  • Physiology (AREA)
  • Human Computer Interaction (AREA)
  • Computing Systems (AREA)
  • Physical Education & Sports Medicine (AREA)
  • Geometry (AREA)
  • Rehabilitation Tools (AREA)

Abstract

The present invention relates to more inertia node wireless monitoring and evaluation systems in a kind of rehabilitation training of upper limbs, including motion sensor, main control chip, electric power management circuit and host computer, the motion sensor and main control chip form motion capture node, carried out data transmission between the motion sensor and main control chip by IIC agreements, the motion sensor, main control chip are connected by electric power management circuit with lithium battery, and the main control chip is connected by wireless telecommunications with host computer.It is an advantage of the invention that solves the problems, such as lack of standardization and nursing staff's heavy workload of upper limb training method in existing house rehabilitation to a certain extent.

Description

Multi-inertial-node wireless monitoring and evaluating system and method in upper limb rehabilitation training
Technical Field
The invention relates to a multi-inertia-node wireless monitoring and evaluating system and method in upper limb rehabilitation training, and belongs to the technical field of rehabilitation training and motion capture.
Background
At present, the techniques for capturing human body motion are generally classified into five major categories, i.e., mechanical, acoustic, electromagnetic, inertial sensor, and optical, among which the optical and inertial sensor are the two most widely used. The optical type adopts photoelectric sensor to gather the motion trail of the person to be measured, then shoots the reflection point of photoelectric sensor through the camera of a plurality of different angles and realizes the action capture, and this kind of mode has high requirement to the environment to the following shortcoming exists: the method is easily influenced by backlight when in shooting, has high cost and has high requirement on hardware for image calculation. Most of traditional inertial sensors are in a wired mode, too many signal lines can influence the movement of arms, and troubles are caused to the rehabilitation training process.
Different training modes need to be selected in different time periods for rehabilitation training, and professional equipment needs to be used for training under the professional guidance of a physiotherapist in the initial stage of cerebral apoplexy rehabilitation treatment. In the later stage of rehabilitation training, the patient has had certain autonomous motion ability, and the rehabilitation of house is just a more convenient, more economic rehabilitation training mode, for making the rehabilitation training of house more normal, just urgent need the wireless monitoring of many inertia nodes and evaluation system in the upper limbs rehabilitation training.
Disclosure of Invention
The invention aims to: aiming at the defects in the prior art, a multi-inertial-node wireless monitoring and evaluating system in upper limb rehabilitation training is provided, and a monitoring and evaluating method is provided.
In order to achieve the purpose, the invention provides a multi-inertial-node wireless monitoring and evaluating system in upper limb rehabilitation training, which comprises a motion sensor, a main control chip, a power management circuit and an upper computer, wherein the motion sensor and the main control chip form an action capturing node, the motion sensor and the main control chip carry out data transmission through an IIC protocol, the motion sensor and the main control chip are connected with a lithium battery through the power management circuit, and the main control chip is connected with the upper computer through wireless communication.
The invention uses an inertial sensor for capturing the motion of the upper limb, collects the data of a patient during rehabilitation exercise through a motion capture node, and then transmits the data by using a wireless network (ZigBee networking technology), and simultaneously provides a motion recognition method and an exercise effect evaluation method.
Preferably, there are three motion capture nodes, node 1, node 2 and node 3.
Further preferably, the node 1 is bound at the chest position of the human body through a rope belt, and the node 1 collects three-axis magnetic force data to judge the orientation of the human body; the node 2 is bound on the outer side of the upper arm of the human body through a rope belt, and the node 2 acquires three-axis acceleration data, three-axis gyroscope data and three-axis magnetic force data; the node 3 is bound on the outer side of the forearm of the human body through a rope belt, and the node 3 acquires three-axis acceleration data, three-axis gyroscope data and three-axis magnetic force data.
Preferably, the motion sensor adopts an MPU9250 nine-axis motion sensor, the main control chip adopts a CC2538ZigBee main control chip, and the upper computer adopts a MatLab upper computer.
The invention also provides a multi-inertia-node wireless monitoring and evaluating method in upper limb rehabilitation training, which comprises the following steps:
firstly, binding motion capture nodes formed by three motion sensors and a main control chip to the chest, the outer side of the upper arm and the outer side of the forearm of a human body respectively to form a node 1, a node 2 and a node 3; turning to the second step;
secondly, performing upper limb rehabilitation training after a training mode is selected on a human-computer interaction interface of the upper computer, wherein the training mode comprises two modes, namely a tracking training mode and a repeated training mode; turning to the third step;
thirdly, in the upper limb rehabilitation training process, a motion sensor of the node 1 collects triaxial magnetic force data of the chest of a human body and transmits the data to a main control chip of the node 1, a motion sensor of the node 2 collects triaxial acceleration data, triaxial gyroscope data and triaxial magnetic force data of the upper arm of the human body and transmits the three data to the main control chip of the node 2, a motion sensor of the node 3 collects triaxial acceleration data, triaxial gyroscope data and triaxial magnetic force data of the forearm of the human body and transmits the three data to the main control chip of the node 3, and the main control chips of the nodes 1, 2 and 3 transmit the data to an upper computer through wireless communication; turning to the fourth step;
and fourthly, judging the posture of the arm by the upper computer according to the received data, and then evaluating the training effect.
Therefore, in the process of upper limb rehabilitation training of a stroke patient, the patient can independently select a training mode, the motion state of the arm can be restored by displaying the motion of the upper limb in real time, the patient can better complete the rehabilitation process by the independently designed training effect evaluation method, and the monitoring and evaluation of the rehabilitation effect are realized.
Preferably, the motion capture node adopts a lithium battery power supply mode, the mode adopts a BQ24230 chip, the chip has two working modes, one mode is a mode of connecting an external power supply, the other mode is a mode of disconnecting the external power supply, when the USB interface is connected with the external power supply, the lithium battery is automatically charged through the power management circuit, and when the external power supply is disconnected, the lithium battery supplies power to the motion capture node.
Preferably, the wireless communication adopts a Z-Stack protocol Stack, the protocol adopts an MESH networking mode, the data transmission mode adopts a timed interrupt transmission mode, and the motion sensor of the motion capture node is in a low-power consumption working mode during data transmission.
Preferably, the upper computer compiles a human-computer interaction interface through a GUI (graphical user interface), controls the wireless communication module to receive the action information data sent by the action capture node, and restores the action information data to obtain the arm motion state; the human-computer interaction interface comprises four parts, namely user login, upper limb action real-time dynamic display, rehabilitation training mode selection and training effect evaluation.
Preferably, after the training mode is selected in the second step, when the training mode is a tracking training mode, the human-computer interaction interface displays a dynamic track of standard actions of rehabilitation training, so that the patient can train according to the standard actions, and meanwhile, the upper computer compares the collected arm motion state of the patient with the dynamic track of the standard actions of rehabilitation training in real time, so that the degree of completion of the actions of the patient can be evaluated conveniently; when the training mode is the repeated training mode, the rehabilitation actions to be completed are set on the human-computer interaction interface, the patient can carry out continuous rehabilitation training according to the set actions, the training actions repeated every ten times are set as a group, and the upper computer scores the completion degree of the patient after the group of actions are completed, so that the rehabilitation training score of the patient is obtained.
Preferably, in the fourth step, the method for determining the posture of the arm is as follows:
⑴ the upper computer judges the orientation of human body according to the formula (1),
or angle3= atan2(1)
Wherein,is the direction angle of the human body,the data is the three-axis magnetic data collected by the node 1 when the human body is upright in the upper limb rehabilitation training process, the geomagnetic data has no component in the vertical direction when the human body is upright,is the direction angle of the forearm of the human body,the data is geomagnetic data when the forearm performs horizontal movement, and the data is triaxial magnetic data collected by the node 3.
⑵ the upper computer processes the nine-axis data acquired by the node 2 by using quaternion and Kalman filtering algorithm to obtain quaternionAnd simultaneously obtaining the attitude angle of the upper arm according to the formula (2),
(2)
wherein,the angle of rotation of the upper arm about the z-axis,the angle of rotation of the upper arm about the x-axis,the angle of rotation of the upper arm about the y-axis,four parameters are respectively used when the upper arm posture data is expressed by a quaternion mode.
⑶ the upper computer processes the nine-axis data acquired by the node 3 by using quaternion and Kalman filtering algorithm to obtain quaternionThen the upper computer obtains the posture angle of the forearm according to the formula (3)
(3)
Wherein,the angle of rotation of the upper arm about the z-axis,the angle of rotation of the upper arm about the x-axis,the angle of rotation of the upper arm about the y-axis,four parameters are respectively used when forearm posture data is expressed in a quaternion mode.
⑷ calculating the posture angle of the forearmTo obtain the natural state of arm's sagging, flat lifting and uplifting. The position of the arm in the front horizontal lifting is coincided with the initialized natural coordinate system, and the attitude angle data in the coincidence process isThus, it is determined whether the arm is in a natural state of sagging, flat-lifting or lifting andthe correlation is large. When in useData proximity ofWhen the arm is in a flat-lifting state,approach toWhen the arm is in a natural drooping state,approach toThe arm is in the raised state. In addition, the first and second substrates are,andthe data of the hand-held robot arm is basically kept unchanged, and whether the hand shakes can be judged according to the small amplitude change condition of the two data.
⑸ the upper computer calculates the included angle between the horizontal direction of the forearm and the horizontal direction of the node 1 according to the formula (4) to obtain the lateral lifting and forward lifting states of the arm,
(4)
wherein,is the included angle between the horizontal direction of the node 1 and the horizontal direction of the front arm. When in useIs composed ofOr is close toWhen the arm is in a forward flat-lifted stateIs composed ofOr is close toThe arms are in a side-lying and lifting state.
⑹ the upper computer calculates the included angle between the upper arm and the forearm according to the formula (5) to obtain the straight and bending state of the arm,
(5)
wherein,the included angle between the upper arm and the forearm. Determine the straightening or bending state of the armThe correlation is relatively large, and the correlation is relatively large,the size of (b) represents the size of the included angle between the upper arm and the forearm,approach toWhen the arm is in a straight state,is composed ofThe forearm and the upper arm are perpendicular to each otherThe greater the degree of flexion of the arm.
The invention has the following advantages:
1. the invention adopts a multi-node motion capture technology, avoids the problem of incomplete information acquisition in the current commonly used single-node motion capture technology, and ensures that the motion monitoring is more accurate;
2. the invention adopts the zigbee wireless networking technology, avoids the problems of complexity, redundancy and inconvenient use of the traditional wired equipment, and also avoids the problem of unfavorable data fusion in the traditional wireless network point-to-point communication;
3. the invention is applied to the upper limb recovery training of the apoplexy patient in the field of rehabilitation medical treatment, realizes remote monitoring and evaluation, standardizes the training requirements of home rehabilitation, and reduces the workload of medical care personnel.
In a word, the invention solves the problems of non-standard upper limb training mode and large workload of nursing staff in the existing home rehabilitation to a certain extent.
Drawings
The invention will be further described with reference to the accompanying drawings.
FIG. 1 is a diagram of a human arm node distribution according to the present invention.
Fig. 2 is a block diagram of the working principle of the present invention.
Fig. 3 is a circuit diagram of a CC2538 in a ZigBee main control chip according to the present invention.
Fig. 4 is a circuit diagram of the motion sensor of the present invention.
Fig. 5 is a circuit diagram of the node power supply chip BQ24230 of the present invention.
FIG. 6 is a flowchart illustrating operation of the human-computer interface according to the present invention.
Detailed Description
Example one
The embodiment provides a multi-inertial-node wireless monitoring and evaluating system in upper limb rehabilitation training, which is structurally shown in fig. 2 to 5 and comprises an MPU250 nine-axis motion sensor, a CC2538ZigBee main control chip, a power management circuit and a MatLab upper computer. The CC2538ZigBee main control chip is connected with a MatLab upper computer through wireless communication, the MPU250 nine-axis motion sensor and the CC2538ZigBee main control chip form an action capturing node, data transmission is carried out between the MPU250 nine-axis motion sensor and the CC2538ZigBee main control chip through an IIC protocol, the clock rate of the data transmission is 400khz, the sampling frequency is 100hz, and the MPU250 nine-axis motion sensor and the CC2538ZigBee main control chip are powered by lithium batteries through a power management circuit. The three motion capture nodes are respectively a node 1, a node 2 and a node 3, the node 1 is bound at the position of the chest of a human body through a rope, the node 1 is positioned at the chest, and the human body is static during rehabilitation training, so that the node 1 can only collect three-axis magnetic force data to judge the orientation of the human body; the node 2 is bound on the outer side of the upper arm of the human body through a rope belt, and the node 2 acquires three-axis acceleration data, three-axis gyroscope data and three-axis magnetic force data; the node 3 is bound on the outer side of the forearm of the human body through a rope belt, and the node 3 acquires three-axis acceleration data, three-axis gyroscope data and three-axis magnetic data (see figure 1).
And the data collected by the motion capture node is transmitted to the upper computer through the routing node and the data receiving node. The data receiving node mainly comprises a CC2538 and a peripheral circuit thereof, collects data sent by the three motion capture nodes, is connected with a computer through UART communication and transmits the data to a MatLab upper computer. The MatLab upper computer compiles a man-machine interaction interface through the GUI, controls a UART (Universal Asynchronous Receiver/Transmitter) to receive action information data, and restores the action information to obtain the arm motion state. During upper limb rehabilitation training of a stroke patient, the patient can independently select a training mode, the upper limb action is displayed in real time to restore the arm motion state, and the patient can better know the rehabilitation process through an independently designed training effect evaluation method.
As shown in fig. 6, the method for wirelessly monitoring and evaluating multiple inertial nodes in upper limb rehabilitation training in this embodiment includes the following steps:
firstly, motion capture nodes formed by three MPU250 nine-axis motion sensors and a CC2538ZigBee main control chip are respectively bound on the chest, the outer side of the upper arm and the outer side of the forearm of a human body to form a node 1, a node 2 and a node 3. The motion capture node adopts a lithium battery power supply mode, the mode adopts a BQ24230 chip, the chip has two working modes, one mode is a mode of connecting an external power supply, the other mode is an external power supply disconnection mode, when the USB interface is connected with the external power supply, the lithium battery is automatically charged through the power management circuit, and when the external power supply is disconnected, the lithium battery supplies power to the motion capture node.
And secondly, performing upper limb rehabilitation training after a training mode is selected on a man-machine interaction interface of the MatLab upper computer, wherein the training mode comprises two modes, namely a tracking training mode and a repeated training mode. The MatLab upper computer compiles a human-computer interaction interface through a GUI (graphical user interface), controls the wireless communication module to receive the action information data sent by the action capture node, and restores the action information data to obtain the arm motion state; the human-computer interaction interface comprises four parts, namely user login, training history, upper limb action real-time dynamic display, rehabilitation training mode selection and training effect evaluation.
The user logs in, and the stroke patient can inquire the rehabilitation process after logging in; training history, training program of next stage. The rehabilitation training process plan of the patient is designed by a rehabilitation doctor, training items and training effect evaluation scores which are done before are recorded, and the patient can reasonably select the rehabilitation training which needs to be carried out at this time in actual use.
The upper limb movement is dynamically displayed in real time, after the movement capture nodes are worn correctly, data can be uploaded to a terminal computer in real time, arm postures are obtained after processing through a multi-node movement fusion algorithm, the arm postures can be displayed by utilizing an arm model on a human-computer interaction interface, the prototype of the arm model is a 5-freedom-degree mechanical arm, the position relation between a human body and an arm and the position relation between an upper arm and a forearm can be simulated as shown in figure 1. The main rehabilitation training actions include:
A. natural sagging → side lift,
B. natural droop → front horizontal lift
C. Bending of arm
D. Front horizontal lift → side horizontal lift
E. Side lift → front lift
F. Side horizontal lifting → top lifting
G. Front horizontal lift → upper lift
When the training movements are carried out, each posture has specific posture characteristics, including static characteristics and dynamic characteristics, the characteristics are also main indexes for training evaluation, the static characteristics mainly include positions of movement starting and stopping points, included angles of forearms and upper arms when the arms do not need to bend and the like, and the dynamic characteristics include whether the tracks of the arms are uniform or not and shake or not when the arms move, whether the tracks are different greatly or not when the arms repeatedly move and the like.
And thirdly, in the upper limb rehabilitation training process, the motion sensor of the node 1 collects the triaxial magnetic force data of the chest of the human body and transmits the data to the main control chip of the node 1, the motion sensor of the node 2 collects the triaxial acceleration data, the triaxial gyroscope data and the triaxial magnetic force data of the upper arm of the human body and transmits the three data to the main control chip of the node 2, the motion sensor of the node 3 collects the triaxial acceleration data, the triaxial gyroscope data and the triaxial magnetic force data of the forearm of the human body and transmits the three data to the main control chip of the node 3, and the main control chips of the nodes 1, 2 and 3 transmit the data to an upper computer through wireless communication. The Z-Stack protocol Stack is adopted in wireless communication, the MESH networking mode is adopted in the protocol, data transmission is powerfully guaranteed, the timing interrupt sending mode is adopted in the data sending mode, the sampling frequency is controlled, the motion sensor of the motion capture node is in a low-power-consumption working mode during data sending, and the continuous working time of the node is effectively prolonged.
And fourthly, judging the posture of the arm by the upper computer according to the received data, and then evaluating the training effect.
The method for judging the posture of the arm comprises the following steps:
⑴ the upper computer judges the orientation of human body according to the formula (1),
or angle3= atan2(1)
Wherein,is the direction angle of the human body,the data is the three-axis magnetic data collected by the node 1 when the human body is upright in the upper limb rehabilitation training process, the geomagnetic data has no component in the vertical direction when the human body is upright,is the direction angle of the forearm of the human body,the data is geomagnetic data when the forearm performs horizontal movement, and the data is triaxial magnetic data collected by the node 3.
⑵ the upper computer processes the nine-axis data collected by the node 2 by quaternion and Kalman filtering algorithm to obtain the attitude angle of the upper arm, and the digital motion controller of MPU9250 is used to obtain the nine-axis data and quaternion of the node 2. The attitude angle of node 2 is obtained by:
wherein the resulting range of arctan and arcsin isThis does not cover all orientations, and the range of values for the theta angle is satisfiedTherefore, it is necessary to replace arctan with atan2 to obtain the following formula:
wherein,the angle of rotation of the upper arm about the z-axis,the angle of rotation of the upper arm about the x-axis,the angle of rotation of the upper arm about the y-axis,four parameters are respectively used when the upper arm posture data is expressed by a quaternion mode.
⑶ the upper computer processes the nine-axis data collected by the node 3 by quaternion and Kalman filtering algorithm to obtain the attitude angle of the forearm, and the digital motion controller of MPU9250 is used to obtain the nine-axis data and quaternion of the node 3. The attitude angle of node 3 is obtained by:
wherein the resulting range of arctan and arcsin isThis does not cover all orientations, and the range of values for the theta angle is satisfiedTherefore, it is necessary to replace arctan with atan3 to obtain the following formula:
wherein,the angle of rotation of the upper arm about the z-axis,the angle of rotation of the upper arm about the x-axis,the angle of rotation of the upper arm about the y-axis,four parameters are respectively used when forearm posture data is expressed in a quaternion mode.
⑷ calculating the posture angle of the forearmTo obtain the natural state of arm's sagging, flat lifting and uplifting. Because the position of the arm in the front horizontal lifting is coincident with the initialized natural coordinate system, the attitude angle data in coincidence isDue to the factThis determines whether the arm is in a natural state of drooping, flat-lifting or lifting andthe correlation is large. When in useData proximity ofWhen the arm is in a flat-lifting state,approach toWhen the arm is in a natural drooping state,approach toThe arm is in the raised state. In addition, the first and second substrates are,andthe data of the hand-held robot arm is basically kept unchanged, and whether the hand shakes can be judged according to the small amplitude change condition of the two data.
⑸ the upper computer calculates the included angle between the horizontal direction of the forearm and the horizontal direction of the node 1 according to the following formula to obtain the lateral lifting and forward lifting states of the arm:
wherein,is the included angle between the horizontal direction of the node 1 and the horizontal direction of the front arm. By passingCan judge the side-lift and front-lift states of the arm whenIs composed ofOr is close toWhen the arm is in a forward flat-lifted stateIs composed ofOr is close toThe arms are in a side-lying and lifting state.
⑹ the upper computer calculates the included angle between the upper arm and the forearm to get the straightening and bending state of the arm according to the following formula:
wherein,the included angle between the upper arm and the forearm. Determine the straightening or bending state of the armThe correlation is relatively large, and the correlation is relatively large,size of (2) representsThe included angle between the arm and the forearm. When in useApproach toWhen the arm is in a straightened stateIs composed ofWhen the forearm is perpendicular to the upper arm,the greater the degree of flexion of the arm.
The rehabilitation training mode has two types, when the training mode is a tracking training mode, the human-computer interaction interface displays the dynamic track of the designed rehabilitation training standard action, so that the patient can train according to the standard action, and meanwhile, the upper computer compares the collected arm motion state of the patient with the dynamic track of the rehabilitation training standard action in real time, so that the completion degree of the action of the patient can be evaluated conveniently. For example, when the side flat lifting training is selected, the rehabilitation action required by a patient is that the arm is lifted to a horizontal state from a natural drooping state through the body side direction at a constant speed, a man-machine interaction interface of an upper computer can display a standard dynamic track of the side flat lifting action and the angle at which the arm needs to be lifted at each moment, the upper computer can compare the arm action with the standard action in real time, when the training evaluation function evaluates that the action completion degree of the patient is qualified, the training is continued, when the action completion degree of the patient is unqualified, the system can remind the patient of the nonstandard action, the patient adjusts the arm according to the feedback information, and the rehabilitation training is continued after the adjustment is completed.
When the training mode is the repeated training mode, the rehabilitation actions to be completed are set on the human-computer interaction interface, the patient can carry out continuous rehabilitation training according to the set actions, the training actions repeated every ten times are set as a group, and the upper computer scores the completion degree of the patient after the group of actions are completed, so that the rehabilitation training score of the patient is obtained. For example, when the lateral lifting training is carried out, the patient needs to complete ten lateral lifting actions, the nonstandard actions cannot be corrected in real time in the training process, the training evaluation function can record the motion condition of the patient, and a comprehensive score is given when the training is finished, so that the training effect is reflected.
In addition, when the two types of training are carried out, object holding training or object holding training can be selected, and the patient can select small objects with different weights to carry out training according to the self condition or the requirements of nursing doctors, so that the rehabilitation training effect can be better achieved.
And the upper computer evaluates the training effect and displays the evaluation result in a training effect evaluation part of the human-computer interaction interface. The training effect evaluation is a main means for judging whether the rehabilitation training of the patient is effective or not, and can enable the patient and a rehabilitation physiotherapist to receive training feedback more intuitively. The evaluation is mainly based on the contact ratio of the arm posture of the patient and the standard posture, the time and the times for completing the rehabilitation training action, the continuity of the arm movement and the shaking condition. The system can comprehensively score according to the aspects and realize the training effect evaluation function.
In addition to the above embodiments, the present invention may have other embodiments. All technical solutions formed by adopting equivalent substitutions or equivalent transformations fall within the protection scope of the claims of the present invention.

Claims (10)

1. The utility model provides a many inertia nodes wireless monitoring and evaluation system in upper limbs rehabilitation training which characterized in that: the motion sensor and the master control chip form a motion capture node, data transmission is carried out between the motion sensor and the master control chip through an IIC protocol, the motion sensor and the master control chip are connected with a lithium battery through the power management circuit, and the master control chip is connected with the upper computer through wireless communication.
2. The system for wirelessly monitoring and evaluating the multiple inertial nodes in the upper limb rehabilitation training according to claim 1, wherein: the motion capture nodes are three, namely node 1, node 2 and node 3.
3. The system for wirelessly monitoring and evaluating the multiple inertial nodes in the upper limb rehabilitation training according to claim 2, wherein: the node 1 is bound at the chest position of a human body through a rope belt, and the node 1 collects three-axis magnetic force data to judge the orientation of the human body; the node 2 is bound on the outer side of the upper arm of the human body through a rope belt, and the node 2 acquires three-axis acceleration data, three-axis gyroscope data and three-axis magnetic force data; the node 3 is bound on the outer side of the forearm of the human body through a rope belt, and the node 3 acquires three-axis acceleration data, three-axis gyroscope data and three-axis magnetic force data.
4. The system for wirelessly monitoring and evaluating the multiple inertial nodes in the upper limb rehabilitation training according to claim 1, wherein: the motion sensor adopts an MPU9250 nine-axis motion sensor, the main control chip adopts a CC2538ZigBee main control chip, and the upper computer adopts a MatLab upper computer.
5. The wireless monitoring and evaluation method for multiple inertial nodes in upper limb rehabilitation training according to any one of claims 1 to 4, characterized by comprising the following steps:
firstly, binding motion capture nodes formed by three motion sensors and a main control chip to the chest, the outer side of the upper arm and the outer side of the forearm of a human body respectively to form a node 1, a node 2 and a node 3; turning to the second step;
secondly, performing upper limb rehabilitation training after a training mode is selected on a human-computer interaction interface of the upper computer, wherein the training mode comprises two modes, namely a tracking training mode and a repeated training mode; turning to the third step;
thirdly, in the upper limb rehabilitation training process, a motion sensor of the node 1 collects triaxial magnetic force data of the chest of a human body and transmits the data to a main control chip of the node 1, a motion sensor of the node 2 collects triaxial acceleration data, triaxial gyroscope data and triaxial magnetic force data of the upper arm of the human body and transmits the three data to the main control chip of the node 2, a motion sensor of the node 3 collects triaxial acceleration data, triaxial gyroscope data and triaxial magnetic force data of the forearm of the human body and transmits the three data to the main control chip of the node 3, and the main control chips of the nodes 1, 2 and 3 transmit the data to an upper computer through wireless communication; turning to the fourth step;
and fourthly, judging the posture of the arm by the upper computer according to the received data, and then evaluating the training effect.
6. The method for wirelessly monitoring and evaluating the multiple inertial nodes in the upper limb rehabilitation training according to claim 5, wherein: the motion capture node adopts a lithium battery power supply mode, the mode adopts a BQ24230 chip, the chip has two working modes, one mode is a mode of connecting an external power supply, the other mode is an external power supply disconnection mode, when the USB interface is connected with the external power supply, the lithium battery is automatically charged through the power management circuit, and when the external power supply is disconnected, the lithium battery supplies power to the motion capture node.
7. The method for wirelessly monitoring and evaluating the multiple inertial nodes in the upper limb rehabilitation training according to claim 5, wherein: the wireless communication adopts a Z-Stack protocol Stack, the protocol adopts an MESH networking mode, a data transmission mode adopts a timed interrupt transmission mode, and a motion sensor of the motion capture node is in a low-power consumption working mode during data transmission.
8. The method for wirelessly monitoring and evaluating the multiple inertial nodes in the upper limb rehabilitation training according to claim 5, wherein: the upper computer compiles a human-computer interaction interface through a GUI (graphical user interface), controls the wireless communication module to receive the action information data sent by the action capture node and restores the action information data to obtain the arm motion state; the human-computer interaction interface comprises four parts, namely user login, upper limb action real-time dynamic display, rehabilitation training mode selection and training effect evaluation.
9. The method for wirelessly monitoring and evaluating the multiple inertial nodes in the upper limb rehabilitation training according to claim 5, wherein: after the training mode is selected, when the training mode is a tracking training mode, a human-computer interaction interface displays a dynamic track of standard actions of rehabilitation training, so that a patient can train according to the standard actions, and meanwhile, an upper computer compares the collected arm motion state of the patient with the dynamic track of the standard actions of rehabilitation training in real time, so that the degree of completion of the actions of the patient can be evaluated conveniently; when the training mode is the repeated training mode, the rehabilitation actions to be completed are set on the human-computer interaction interface, the patient can carry out continuous rehabilitation training according to the set actions, the training actions repeated every ten times are set as a group, and the upper computer scores the completion degree of the patient after the group of actions are completed, so that the rehabilitation training score of the patient is obtained.
10. The method for wirelessly monitoring and evaluating the multiple inertial nodes in the upper limb rehabilitation training according to claim 5, wherein: in the fourth step, the method for judging the posture of the arm comprises the following steps:
⑴ the upper computer judges the orientation of human body according to the formula (1),
or angle3= atan2(1)
Wherein,is the direction angle of the human body,is geomagnetic data when the human body stands upright in the upper limb rehabilitation training process,is the direction angle of the forearm of the human body,geomagnetic data when the forearm is subjected to horizontal movement;
⑵ the upper computer processes the nine-axis data acquired by the node 2 by using quaternion and Kalman filtering algorithm to obtain quaternionAnd simultaneously obtaining the attitude angle of the upper arm according to the formula (2),
(2)
wherein,the angle of rotation of the upper arm about the z-axis,the angle of rotation of the upper arm about the x-axis,the angle of rotation of the upper arm about the y-axis,four parameters when the upper arm posture data are expressed in a quaternion mode are respectively represented;
⑶ the upper computer processes the nine-axis data acquired by the node 3 by using quaternion and Kalman filtering algorithm to obtain quaternionThen the upper computer obtains the posture angle of the forearm according to the formula (3)
(3)
Wherein,the angle of rotation of the upper arm about the z-axis,the angle of rotation of the upper arm about the x-axis,the angle of rotation of the upper arm about the y-axis,four parameters when the forearm posture data is expressed by a quaternion mode are respectively represented;
⑷ calculating the posture angle of the forearmTo obtain the natural states of arm droop, horizontal lifting and uplifting;
⑸ the upper computer calculates the included angle between the horizontal direction of the forearm and the horizontal direction of the node 1 according to the formula (4) to obtain the lateral lifting and forward lifting states of the arm,
(4)
wherein,is the included angle between the horizontal direction of the node 1 and the horizontal direction of the front arm;
⑹ the upper computer calculates the included angle between the upper arm and the forearm according to the formula (5) to obtain the straight and bending state of the arm,
(5)
wherein,the included angle between the upper arm and the forearm.
CN201810082314.9A 2018-01-29 2018-01-29 More inertia node wireless monitoring and evaluation system and methods in rehabilitation training of upper limbs Pending CN108187333A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810082314.9A CN108187333A (en) 2018-01-29 2018-01-29 More inertia node wireless monitoring and evaluation system and methods in rehabilitation training of upper limbs

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810082314.9A CN108187333A (en) 2018-01-29 2018-01-29 More inertia node wireless monitoring and evaluation system and methods in rehabilitation training of upper limbs

Publications (1)

Publication Number Publication Date
CN108187333A true CN108187333A (en) 2018-06-22

Family

ID=62591677

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810082314.9A Pending CN108187333A (en) 2018-01-29 2018-01-29 More inertia node wireless monitoring and evaluation system and methods in rehabilitation training of upper limbs

Country Status (1)

Country Link
CN (1) CN108187333A (en)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108888480A (en) * 2018-08-17 2018-11-27 珠海市源力智能科技有限公司 Knee-joint rehabilitation training equipment
CN109011517A (en) * 2018-08-15 2018-12-18 成都大学 Joint rehabilitation training equipment
CN109171735A (en) * 2018-08-03 2019-01-11 郑州飞铄电子科技有限公司 A kind of angle measurement system for human action attitude algorithm
CN110327048A (en) * 2019-03-11 2019-10-15 浙江工业大学 A kind of human upper limb posture reconstruction system based on wearable inertial sensor
CN111714334A (en) * 2020-07-13 2020-09-29 厦门威恩科技有限公司 Upper limb rehabilitation training robot and control method
CN111803906A (en) * 2020-06-30 2020-10-23 广州喜梁门科技有限公司 Intelligent auxiliary stabilizer for exercise training
CN111991762A (en) * 2020-09-02 2020-11-27 冼鹏全 Psychotherapy-based wearable upper limb rehabilitation device for stroke patient and cooperative working method
CN113181619A (en) * 2021-04-09 2021-07-30 青岛小鸟看看科技有限公司 Exercise training method, device and system
CN113952700A (en) * 2021-11-22 2022-01-21 深圳市天鹏宇科技有限公司 Intelligent fitness interaction system and intelligent fitness remote guidance system
CN114053679A (en) * 2021-11-19 2022-02-18 上海复动医疗管理有限公司 Exercise training method and system

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011110997A2 (en) * 2010-03-09 2011-09-15 Gymtek Technologies Ltd. Method and system for an exercise unit
CN203075563U (en) * 2012-11-15 2013-07-24 王勇 Intelligent fitness chair control system
CN103417201A (en) * 2013-08-06 2013-12-04 中国科学院深圳先进技术研究院 Physical exercise training assisting system collecting human body postures and implementation method thereof
CN203763810U (en) * 2013-08-13 2014-08-13 北京诺亦腾科技有限公司 Club/racket swinging assisting training device
CN204600508U (en) * 2015-04-24 2015-09-02 曾菊 Wearable lower limb rehabilitation training and walking aid system
CN105496418A (en) * 2016-01-08 2016-04-20 中国科学技术大学 Arm-belt-type wearable system for evaluating upper limb movement function
CN106308810A (en) * 2016-09-27 2017-01-11 中国科学院深圳先进技术研究院 Human motion capture system
CN106643872A (en) * 2016-10-10 2017-05-10 江门出入境检验检疫局检验检疫技术中心 Spatial photometric distribution intelligent monitoring system based on Zigbee
CN206700691U (en) * 2017-04-29 2017-12-05 浙江大学台州研究院 A kind of upper extremity exercise control is assessed and the mechanism of rehabilitation training

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011110997A2 (en) * 2010-03-09 2011-09-15 Gymtek Technologies Ltd. Method and system for an exercise unit
CN203075563U (en) * 2012-11-15 2013-07-24 王勇 Intelligent fitness chair control system
CN103417201A (en) * 2013-08-06 2013-12-04 中国科学院深圳先进技术研究院 Physical exercise training assisting system collecting human body postures and implementation method thereof
CN203763810U (en) * 2013-08-13 2014-08-13 北京诺亦腾科技有限公司 Club/racket swinging assisting training device
CN204600508U (en) * 2015-04-24 2015-09-02 曾菊 Wearable lower limb rehabilitation training and walking aid system
CN105496418A (en) * 2016-01-08 2016-04-20 中国科学技术大学 Arm-belt-type wearable system for evaluating upper limb movement function
CN106308810A (en) * 2016-09-27 2017-01-11 中国科学院深圳先进技术研究院 Human motion capture system
CN106643872A (en) * 2016-10-10 2017-05-10 江门出入境检验检疫局检验检疫技术中心 Spatial photometric distribution intelligent monitoring system based on Zigbee
CN206700691U (en) * 2017-04-29 2017-12-05 浙江大学台州研究院 A kind of upper extremity exercise control is assessed and the mechanism of rehabilitation training

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109171735A (en) * 2018-08-03 2019-01-11 郑州飞铄电子科技有限公司 A kind of angle measurement system for human action attitude algorithm
CN109011517A (en) * 2018-08-15 2018-12-18 成都大学 Joint rehabilitation training equipment
CN108888480A (en) * 2018-08-17 2018-11-27 珠海市源力智能科技有限公司 Knee-joint rehabilitation training equipment
CN110327048B (en) * 2019-03-11 2022-07-15 浙江工业大学 Human upper limb posture reconstruction system based on wearable inertial sensor
CN110327048A (en) * 2019-03-11 2019-10-15 浙江工业大学 A kind of human upper limb posture reconstruction system based on wearable inertial sensor
CN111803906A (en) * 2020-06-30 2020-10-23 广州喜梁门科技有限公司 Intelligent auxiliary stabilizer for exercise training
CN111714334A (en) * 2020-07-13 2020-09-29 厦门威恩科技有限公司 Upper limb rehabilitation training robot and control method
CN111714334B (en) * 2020-07-13 2022-08-05 厦门威恩科技有限公司 Upper limb rehabilitation training robot and control method
CN111991762A (en) * 2020-09-02 2020-11-27 冼鹏全 Psychotherapy-based wearable upper limb rehabilitation device for stroke patient and cooperative working method
CN113181619A (en) * 2021-04-09 2021-07-30 青岛小鸟看看科技有限公司 Exercise training method, device and system
US11872468B2 (en) 2021-04-09 2024-01-16 Qingdao Pico Technology Co., Ltd. Sport training method and system and head-mounted VR device
CN114053679A (en) * 2021-11-19 2022-02-18 上海复动医疗管理有限公司 Exercise training method and system
CN113952700A (en) * 2021-11-22 2022-01-21 深圳市天鹏宇科技有限公司 Intelligent fitness interaction system and intelligent fitness remote guidance system

Similar Documents

Publication Publication Date Title
CN108187333A (en) More inertia node wireless monitoring and evaluation system and methods in rehabilitation training of upper limbs
CN106725381B (en) Intelligent fitness exercise bracelet
CN103895022A (en) Wearable type somatosensory control mechanical arm
CN105690386B (en) A kind of mechanical arm remote control system and teleoperation method
TWI617908B (en) Robot arm control device, robot arm system including the control device and robot arm control method
CN206224385U (en) A kind of motion capture system with positioning function for reality environment
CN107856014B (en) Mechanical arm pose control method based on gesture recognition
CN202218347U (en) Motion attitude capturing device and system of motion attitude capturing device
CN108098780A (en) A kind of new robot apery kinematic system
CN104881118A (en) Wearable system used for capturing upper limb movement information of human body
CN112891137A (en) Upper limb rehabilitation robot system, robot control method and device
CN106853638A (en) A kind of human-body biological signal tele-control system and method based on augmented reality
CN114983791A (en) Wearable cardiopulmonary resuscitation auxiliary system and method for cooperative monitoring of medical behaviors
CN108379815A (en) The automation training system with Real-time Feedback based on elastic intelligent sensor node
CN203552178U (en) Wrist strip type hand motion identification device
CN204725501U (en) Body sense mechanical arm comfort level checkout gear
CN109801709A (en) A kind of system of hand gestures capture and health status perception for virtual environment
CN109343713B (en) Human body action mapping method based on inertial measurement unit
CN111870249A (en) Human body posture tracking system based on micro inertial sensor and use method thereof
CN105843388B (en) A kind of data glove system
TWM524175U (en) A determination system of cervical strain
CN115116141A (en) Physical training monitoring system
Abdallah et al. IoT device for Athlete's movements recognition using inertial measurement unit (IMU)
CN211484594U (en) Body feeling balance detector
CN210757705U (en) Energy-increasing wearable arm and upper limb exoskeleton device

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20180622