CN114177588A - Vibration feedback system, method and device of rehabilitation robot - Google Patents
Vibration feedback system, method and device of rehabilitation robot Download PDFInfo
- Publication number
- CN114177588A CN114177588A CN202111515051.4A CN202111515051A CN114177588A CN 114177588 A CN114177588 A CN 114177588A CN 202111515051 A CN202111515051 A CN 202111515051A CN 114177588 A CN114177588 A CN 114177588A
- Authority
- CN
- China
- Prior art keywords
- vibration
- signal
- vibration feedback
- real
- feedback
- 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.)
- Granted
Links
Images
Classifications
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B23/00—Exercising apparatus specially adapted for particular parts of the body
- A63B23/035—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously
- A63B23/12—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously for upper limbs or related muscles, e.g. chest, upper back or shoulder muscles
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B24/00—Electric or electronic controls for exercising apparatus of preceding groups; Controlling or monitoring of exercises, sportive games, training or athletic performances
- A63B24/0087—Electric or electronic controls for exercising apparatus of groups A63B21/00 - A63B23/00, e.g. controlling load
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B71/00—Games or sports accessories not covered in groups A63B1/00 - A63B69/00
- A63B71/06—Indicating or scoring devices for games or players, or for other sports activities
- A63B71/0619—Displays, user interfaces and indicating devices, specially adapted for sport equipment, e.g. display mounted on treadmills
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B71/00—Games or sports accessories not covered in groups A63B1/00 - A63B69/00
- A63B71/06—Indicating or scoring devices for games or players, or for other sports activities
- A63B71/0619—Displays, user interfaces and indicating devices, specially adapted for sport equipment, e.g. display mounted on treadmills
- A63B2071/0655—Tactile feedback
Abstract
The invention belongs to the field of rehabilitation robots, and particularly relates to a vibration feedback system, a vibration feedback method and a vibration feedback device of a rehabilitation robot. Judging the muscle strength grade of the patient by a muscle strength grade judging module; and the vibration feedback calculation module obtains a vibration feedback grade according to the muscle force grade and calculates a vibration signal parameter. The event signal calculation module calculates a real-time vibration feedback signal according to the vibration event, the vibration feedback grade and the vibration signal parameter; and superposing to form a total torque control signal, and sending the total torque control signal to the motor driver. The invention provides the vibration feedback force by utilizing the existing motor on the equipment, and does not need to additionally install a vibration motor; the volume of the operating handle is reduced, and the equipment cost is reduced; the amplitude and the frequency of the vibration signal can be adjusted in a larger range, and the problem that a patient with impaired hand perception ability cannot feel the vibration is solved.
Description
Technical Field
The invention belongs to the field of rehabilitation robots, and particularly relates to a vibration feedback system, method and device of a rehabilitation robot.
Background
At present, in the process of exercise rehabilitation, a patient generally uses rehabilitation equipment to cooperate with a corresponding game scene to carry out exercise training. In part of game scenes, the equipment is required to provide vibration feedback to improve the interactive experience of patients and the game scenes, so that a better treatment effect is achieved. In addition, for patients with amblyopia or blindness, tactile feedback is required to guide the patient through rehabilitation training. The rehabilitation products on the market do not have the function.
The existing rehabilitation device is shown in fig. 1 (CN113244578A, fig. 1 and 2), and the hands of the patient grasp the vertical handle to perform rehabilitation training. The controller collects the force of the patient through the two-dimensional force sensor to control the X-direction servo motor and the Y-direction servo motor to provide corresponding assistance/resistance, and transmits the assistance/resistance to the vertical handle through the synchronous belt (equivalent to an X-direction flexible cable and a Y-direction flexible cable in CN 113244578A), and further transmits the assistance/resistance to the hand of the user, so as to achieve the purpose of exercising the strength of the upper limbs of the patient. However, almost no function of providing tactile feedback exists in the existing upper limb rehabilitation equipment, and certain influence is brought to the interactive experience in the training process.
Patent CN208673182U discloses a vibration control handle providing vibration feedback to a user by mounting a vibration motor in the handle. This approach requires an additional vibration motor to be mounted on the rehabilitation device, increasing the size of the handle and also increasing the cost of the device. The vibration motor can provide less vibration force and may not be able to sense the vibration for a patient with impaired hand perception.
To solve the above problems, the present invention proposes an apparatus and method for providing vibration feedback.
Disclosure of Invention
In order to overcome the problems in the prior art, the invention provides a vibration feedback system, a method and a device of a rehabilitation robot, which do not need to be additionally provided with a vibration motor and have a large vibration feedback adjustment range.
In order to achieve the above object, the present invention adopts the following technical solutions: a vibration feedback system of a rehabilitation robot is characterized by comprising a training feedback module, an event signal calculation module and a moment and vibration signal superposition module;
the training feedback module comprises a muscle strength grade judging module and a vibration feedback calculating module; judging the muscle strength grade of the patient by a muscle strength grade judging module; the vibration feedback calculation module obtains a vibration feedback grade according to the muscle force grade and calculates a vibration signal parameter;
the event signal calculation module receives a vibration event signal from a game and calculates a real-time vibration feedback signal according to the vibration feedback grade and the vibration signal parameter of the current user;
the moment and vibration signal superposition module receives the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal, superposes the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal to form a total moment control signal, and sends the total moment control signal to the motor driver.
The real-time torque control instruction is as follows: according to the game scene and the training mode, different torque value commands sent by the robot controller to the motor driver are generated by the impedance control module.
The modeling error compensation signal is generated by a modeling error compensation module, and is equal to the real-time moment control instruction minus the force signal detected by the force sensor. The modeling error compensation module is also integrated into the robot controller.
The event signal calculation module receives a vibration event signal sent by a game, wherein the vibration event signal comprises a vibration frequency omega and a duration time T; if N vibration events occur simultaneously in the game, the signal of the ith vibration event is Fi＝sin(wit)t∈[0，Ti](2) Then the real-time vibration event signal is
The vibration feedback grade and the muscle strength grade are in positive correlation, namely the higher the muscle strength grade is, the higher the vibration feedback grade is. Feasible schemeIt is the vibration feedback level that is equal to the muscle force level. The amplitude of the vibration feedback signal is in positive correlation with the vibration feedback level, namely the higher the vibration feedback level is, the larger the amplitude of the vibration feedback signal is. One possible solution is to have the amplitude a of the vibration feedback signal equal to 2LvWherein L isvIndicating the level of vibration feedback. Finally obtaining the actual vibration feedback signal FvAF. I.e. the actual vibration feedback signal FvEqual to the amplitude a of the vibration feedback signal multiplied by the real-time vibration event signal F.
Vibration feedback level LvThe vibration feedback signal is calculated by the vibration feedback calculation module, and the actual vibration feedback signal is calculated by the event signal calculation module.
Still another object of the present invention is to provide a vibration feedback method of a rehabilitation robot, comprising the steps of:
judging the muscle strength grade of the patient by a muscle strength grade judging module; the vibration feedback calculation module obtains a vibration feedback grade according to the muscle force grade and calculates a vibration signal parameter;
the event signal calculation module receives a vibration event signal from a game and calculates a real-time vibration feedback signal according to the vibration feedback grade and the vibration signal parameter of the current user;
the moment and vibration signal superposition module receives the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal, superposes the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal to form a total moment control signal, and sends the total moment control signal to the motor driver to drive the motor to generate torque.
The invention also aims to provide a vibration feedback device of a rehabilitation robot, which comprises a robot controller, wherein a training feedback module, an event signal calculation module, a moment and vibration signal superposition module, an impedance control module and a modeling error compensation module are integrated in the robot controller;
the training feedback module comprises a muscle strength grade judging module and a vibration feedback calculating module; judging the muscle strength grade of the patient by a muscle strength grade judging module; the vibration feedback calculation module obtains a vibration feedback grade according to the muscle force grade and calculates a vibration signal parameter;
the event signal calculation module receives a vibration event signal from a game and calculates a real-time vibration feedback signal according to the vibration feedback grade and the vibration signal parameter of the current user;
generating a real-time torque control command by an impedance control module, and generating a modeling error compensation signal by a modeling error compensation module;
the moment and vibration signal superposition module receives the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal, superposes the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal to form a total moment control signal, and sends the total moment control signal to the motor driver.
Compared with the prior art, the invention has the beneficial effects that: the existing driving motor of the upper limb rehabilitation equipment is used as a vibration generator to provide vibration feedback for the patient. A vibration feedback control scheme based on impedance control is provided, which can provide vibration feedback for a patient according to a real-time interaction scene.
The existing motor on the equipment is used for providing vibration feedback force, and a vibration motor does not need to be additionally installed. The volume of the operating handle is reduced, and the equipment cost is reduced. Compared with a vibration motor, the amplitude and the frequency of the vibration signal of the scheme can be adjusted in a larger range, and the problem that a patient with impaired hand perception capability cannot feel vibration is solved.
Drawings
FIG. 1 is a flow chart of a rehabilitation robot vibration feedback;
FIG. 2 is a general impedance control block diagram;
FIG. 3 is a control block diagram of the present invention;
fig. 4 is a schematic diagram of muscle strength level determination.
Detailed Description
The invention is described in detail below with reference to the figures and the embodiments.
The invention discloses a vibration feedback system, a method and a device of an upper limb rehabilitation robot. The specific principle is as follows:
the training feedback module, the event signal calculation module, the moment and vibration signal superposition module, the impedance control module and the modeling error compensation module are all integrated in the robot controller. Training feedback modelThe block comprises a muscle strength grade judging module and a vibration feedback calculating module; judging the muscle strength grade of the current user by a muscle strength grade judging module; the vibration feedback calculation module obtains a vibration feedback level (for example, the muscle force level is equal to the vibration feedback level) according to the muscle force level, and calculates a vibration signal parameter (amplitude A of the vibration feedback signal). The event signal calculation module receives vibration event signals from games, and calculates real-time vibration feedback signals F according to the vibration feedback grade and the vibration signal parameters of the current userv(ii) a Generating a real-time torque control command f by an impedance control moduledGenerating a modeling error compensation signal (real-time torque control command f) by a modeling error compensation moduledForce signal F detected by the force sensors) (ii) a Wherein the modeling error compensation module receives a real-time moment control command f sent by the impedance control moduledAnd a force signal F detected by the force sensorsSubtracting the two signals to obtain a modeling error compensation signal; the moment and vibration signal superposition module receives a real-time moment control instruction given by the impedance control module and a real-time vibration feedback signal F given by the event signal calculation modulevAnd a modeling error compensation signal sent by the modeling error compensation module, and the modeling error compensation signal, the modeling error compensation module and the total torque control signal are superposed to form a total torque control signal (namely f)d+(fd-Fs)+Fv) And sent to the motor driver. The real-time torque control instruction is as follows: according to the game scene and the training mode selected by the patient, the impedance control module of the robot controller gives the instruction, the instruction is sent to the moment and vibration signal superposition module, and is sent to the motor driver by the moment and vibration signal superposition module after being superposed with the real-time vibration feedback signal and the modeling error compensation signal, the motor is driven, and assistance or resistance and vibration feedback is provided for the patient, so that the training purpose is achieved.
The invention discloses a vibration feedback system, a method and a device of an upper limb rehabilitation robot. The specific principle is as follows:
1. before the rehabilitation training of the patient, the tactile perception capability of the patient is judged through the training feedback module so as to determine the grade and the parameter of the vibration feedback signal. During the training process, the patient holds the vertical handle to move on the plane of the equipment (the equipment is an upper limb rehabilitation robot). Meanwhile, the coordinates of the equipment (the coordinates of the vertical handle) are sent to a game interface through the robot controller, and the elements in the game are controlled to move. When a vibration event (such as a collision event or an event needing to simulate vibration (such as when an uneven road is simulated)) occurs in a game scene, the game gives a corresponding vibration feedback signal according to the event signal calculation module and sends the vibration feedback signal to the equipment, and specifically, the vibration feedback signal is sent to a moment and vibration signal superposition module of a robot controller of the upper limb rehabilitation robot. Meanwhile, the impedance control module sends a real-time moment control instruction to the moment and vibration signal superposition module. Meanwhile, a modeling error compensation module generates a modeling error compensation signal and sends the modeling error compensation signal to a moment and vibration signal superposition module; after receiving the real-time torque control instruction, the torque and vibration signal superposition module of the robot controller superposes a real-time vibration feedback signal and a modeling error compensation signal (the real-time torque control instruction, the real-time vibration feedback signal and the modeling error compensation signal are directly added) on the current real-time torque control instruction, and thus the robot controller can generate the vibration feedback while generating the assistance/resistance. The vibration feedback of the motor is transmitted to the tail end operating handle (namely the vertical handle) through a synchronous belt (not limited to the synchronous belt) and then transmitted to the arm of a person. The flow chart is shown in fig. 1.
On the basis of the hardware structure of the upper limb rehabilitation robot of CN113244578A, the vibration feedback system of the invention is arranged in the robot controller. The hardware structure of the upper limb rehabilitation robot to which the invention is applied can be completely the same as or equal to that of the CNCN113244578A, but the control system of the invention is different from CN 113244578A.
2. The vibration feedback signal is generally a sinusoidal signal (but not limited to a sinusoidal signal), and the parameters include vibration frequency, vibration amplitude and vibration duration;
f＝A·sin(ω·t) 0＜t＜T (1)
wherein f represents a signal value, A represents the amplitude (the value range is 0-10N) of the vibration feedback signal, omega represents the signal frequency (the value range is 8-60 Hz), T represents the time (the unit is s), and T represents the duration of the vibration signal. The amplitude a of the vibration feedback signal is typically taken to a small value in order not to affect the boost/resistance required for training.
3. The event signal calculation receives the vibration event signals and vibration parameters (including signal frequency and duration) from the game, and if there are multiple vibration event signals, then all vibration event signals are weighted averaged. And multiplying the result by the vibration amplitude to obtain a final actual vibration feedback signal. The signal frequency ω and duration T of different vibration events are different and are given directly by the game. The specific process is as follows:
a) the signal frequency and duration corresponding to different vibration events are preset in the game, and when one or more vibration events occur, the game sends vibration event signals and parameters to the controller. If N vibration events occur simultaneously, the signal of the ith (i-1.. N) vibration event is
Fi＝sin(wit) t∈[0，Ti](2) ω in the formula (2)iA signal frequency representing the ith vibration event, where i ═ 1, 2, 3 … N; t isiRepresents the duration of the ith vibration event; t represents time (in units of s);
the real-time vibration event signal is
I.e. when N vibration events occur within one control period (e.g. 2ms), F of all events is determinediThe values are directly added and averaged to obtain the real-time vibration event signal (i.e. the vibration event signals of all vibration events at the current time are weighted and averaged).
b) Obtaining the vibration feedback grade through a training feedback module, and obtaining the vibration feedback grade according to the formula A-2LvDetermining the amplitude of the vibration feedback signal (i.e. A is L)v2 times higher). The amplitude A of the vibration feedback signal is multiplied by the real-time vibration event signal F to obtain a final real-time vibration feedback signal Fv。
In one embodiment, the real-time vibration feedback signal FvAnd decomposing the vibration feedback signal according to the real-time motion direction of the equipment (namely the vertical handle), and respectively adding the decomposed vibration feedback signal values to motor drivers of the X-direction servo motor and the Y-direction servo motor. For example, for the hardware structure of CN113244578A, the specific decomposition process is as follows:
respectively reading the linear velocity V of the vertical handle in the X direction from the two motor driversxAnd the linear velocity V of the vertical handle in the Y directiony. The vibration signal F resolved to the X-direction servo motor is obtained according to the following formulavxAnd a vibration signal F decomposed to the Y-direction servo motorvy. Wherein VnormRepresenting the modulo length of the velocity vector.
4. The motor driver works in a torque mode, and a corresponding total torque control signal is obtained through calculation of the robot controller and is sent to the motor driver to drive the motor to generate torque. It is a real-time control, and the control period can be 2ms in general.
A general impedance control block diagram is shown in fig. 2, which is a prior art, i.e., an impedance control module of the present invention; wherein the content of the first and second substances,
to the desired speed, zdTo the controller impedance, JTIs the transpose of the Jacobian matrix of the robot,
a dynamical model of the robot is represented, and J represents a Jacobian matrix of the robot. Impedance zdThe expression of (b) has the following form (the first mode is taken as an example in the present embodiment);
where x represents the actual position (i.e. the actual position of the vertical handle),
representing the actual speed (of the vertical handle),
representing the actual acceleration (of the vertical handle). x is the number ofdIndicating a desired position (desired position of the vertical handle when the patient is not exerting force),
indicating a desired speed (desired speed of the vertical handle when the patient is not exerting force),
indicating a desired acceleration (of the vertical handle when the patient is not exerting force). M represents a mass parameter, B represents a damping parameter, and K represents a stiffness parameter. M is generally 0.1 to 10Kg, B is generally 5 to 1000N M/s, and K is generally 0. These parameters vary depending on the training mode or the game scenario. In case of strong upper limb strength of the patient, M, B, K parameters can be increased to increase the training resistance of the patient. In case of weak strength of the patient, these 3 parameters can be reduced to reduce the training resistance of the patient. f. ofdRepresenting the force required to be applied to the patient's hand, transposed J through the Jacobian matrixTConverted into joint force tauc. While the patient exerts a force F directly on the tipuThe transformation also transposed by the Jacobian matrix acts on the robot. The resultant force of the two acts on a robot dynamics model
On the upper part, the robot joint is driven to generate the movement speed
Obtaining the motion speed of the space coordinate system through Jacobian matrix transformation
And contacts the hand of the patient and generates a contact force Fu(also known as the force applied directly to the tip by the patient).
The improved control block diagram of the present invention is shown in fig. 3. Wherein the content of the first and second substances,
at a desired speed (desired speed of the vertical handle when the patient is not exerting force), zdTo the controller impedance, JTIs the transpose of the Jacobian matrix of the robot,
representing a kinetic model of the robot, J representing a Jacobian matrix of the robot, FvRepresenting a real-time vibration feedback signal, fdIndicating the force required to be applied to the patient's hand (f)dNamely a real-time moment control instruction given by the impedance control module); force F applied directly at the tip by the patientuDetected by the force sensor, and the force signal detected by the force sensor is FsModeling error compensation module makes fdSubtracting FsAnd obtaining a modeling error compensation signal. Real-time vibration feedback signal FvReal-time torque control command fdAnd a modeling error compensation signal fd-FsTogether by transposition of the Jacobian matrix JTBecomes the joint force tauc(for the structure of one X-direction servo motor and one Y-direction servo motor, which are vectors, including the torque applied to the X-direction servo motor and the torque applied to the Y-direction servo motor). I.e. the vibration feedback signal FvReal-time torque control command fdThe total moment control signal formed by the superposition of the modeling error compensation signal and the transposition J of the Jacobian matrixTAnd the torques of the two motors are respectively obtained, and the total torque control signal is decomposed to the two motors. The number of motors is arbitrary and is not limited to a combination of one X-direction servo motor and one Y-direction servo motor. And general resistanceCompared with the anti-control method, the invention adds the force sensor to measure the contact force between the tail end of the equipment and the patient, compensates the modeling error of the robot dynamic model, and adds the real-time vibration feedback signal FvFor simulating vibration feedback.
In fig. 2 and 3, only the first expression in the formula (4) is shown
For example.
Real-time vibration feedback signal FvAnd the impedance signal (i.e., the aforementioned real-time torque control command, calculated by equation (4), e.g., calculated by the first equation in equation (4)) are independent of each other, and both act together on the current user (patient). The impedance is used to simulate elastic, damping and inertial forces in a virtual environment. The vibration signal is then an analog vibration.
The training feedback module determines a level of the vibratory feedback signal by determining a muscle strength level of the patient. Referring to fig. 4, the flow of determining the muscle strength level is as follows.
a) Calculating the muscle strength grade of the current user by a muscle strength grade judging module: the patient is led to respectively exert force in 8 directions (A1-A8, the included angle between two adjacent directions is 45 degrees) in the figure 4 under the guidance of a software interface, the force sensor detects the force exerted by the patient and sends the force to the robot controller, the robot controller records the force, and the muscle strength grade (J) of the patient is obtained after calculation.
The patient exertion levels detected in the 8 directions A1-A8 in FIG. 4 are F1, F2, F3, F4, F5, F6, F7 and F8 respectively, and in one embodiment, the average of the F1-F8 is calculated as pF, and if the pF is 0-10N, the muscle strength grade is 1; if pF is 10-20N (excluding 10N, including 20N), the muscle strength grade is 2 grade; if pF is 20-30N (excluding 20N, including 30N), the muscle strength grade is 3 grade; if pF is 30-40N (excluding 30N, including 40N), the muscle strength grade is 4 grade; if pF is 40N or more (40N is not included), the muscle strength level is 5. The muscle force level is equal to the vibration feedback level.
In another embodiment, considering that the muscle force levels of the patients in different movement directions may be different, the muscle force levels corresponding to the forces F1, F2, F3, F4, F5, F6, F7 and F8 in 8 directions are respectively recorded; when any one of F1-F8 is 0-10N, the muscle strength grade is 1 grade; if the muscle strength is 10-20N (10N is not included, 20N is included), the muscle strength grade is 2 grade; if the muscle strength is 20-30N (excluding 20N, including 30N), the muscle strength grade is 3 grade; if the muscle strength is 30-40N (excluding 30N and including 40N), the muscle strength grade is 4; if the muscle strength is more than 40N (excluding 40N), the muscle strength grade is 5 grade; then, when calculating the vibration signal, the current movement direction of the device (vertical handle) is calculated, and then it is determined which of the 8 directions the current movement direction belongs to or is closest to. And substituting the corresponding muscle strength grade into the calculated vibration signal. For example, the moving direction belongs to the A2 direction when the moving direction is 22.5-67.5, and belongs to the A3 direction when the moving direction is 67.5-112.5.
b) A and L are calculated by a vibration feedback calculation modulev: and calculating the vibration feedback grade and the vibration signal parameter according to the muscle force grade of the patient. One feasible calculation method is to calculate the vibration feedback level LvEqual to the muscle force level J, the amplitude a of the vibration feedback signal is linear with the vibration feedback level, i.e.:
A＝2Lv (5)
wherein L isvFor vibration feedback level, the general case is 1-5 levels.
It should be understood by those skilled in the art that the above embodiments do not limit the present invention in any way, and all technical solutions obtained by using equivalent alternatives or equivalent variations fall within the scope of the present invention.
Claims (8)
1. A vibration feedback system of a rehabilitation robot is characterized by comprising a training feedback module, an event signal calculation module and a moment and vibration signal superposition module;
the training feedback module comprises a muscle strength grade judging module and a vibration feedback calculating module; judging the muscle strength grade of the patient by a muscle strength grade judging module; the vibration feedback calculation module obtains a vibration feedback grade according to the muscle force grade and calculates a vibration signal parameter;
the event signal calculation module receives a vibration event signal from a game and calculates a real-time vibration feedback signal according to the vibration feedback grade and the vibration signal parameter of the current user;
the moment and vibration signal superposition module receives the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal, superposes the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal to form a total moment control signal, and sends the total moment control signal to the motor driver.
2. The vibration feedback system of a rehabilitation robot according to claim 1, wherein the real-time torque control command is: according to the game scene and the training mode, the robot controller sends different torque value commands to the motor driver, and the impedance control module generates the commands.
3. The vibration feedback system of a rehabilitation robot according to claim 1, wherein said modeling error compensation signal is generated by a modeling error compensation module, said modeling error compensation signal being equal to the real-time torque control command minus the force signal detected by the force sensor.
4. The vibration feedback system of a rehabilitation robot according to claim 1, wherein the event signal calculating module receives a vibration event signal sent by a game, and the vibration event signal comprises a vibration frequency ω and a duration T; if N vibration events occur simultaneously in the game, the signal of the ith vibration event is Fi＝sin(ωit)t∈[0，Ti](2) Then the real-time vibration event signal is
5. The vibration feedback system of a rehabilitation robot as claimed in claim 1, wherein said vibration feedback level is positively correlated to the muscle strength level, i.e. the higher the muscle strength level, the higher the vibration feedback level; the amplitude of the vibration feedback signal is in positive correlation with the vibration feedback level, namely the higher the vibration feedback level is, the larger the amplitude of the vibration feedback signal is.
6. The vibration feedback system of a rehabilitation robot according to claim 5, wherein said vibration feedback level is equal to a muscle force level; amplitude A of the vibration feedback signal is 2LυWherein L isυRepresenting a vibration feedback level; finally obtaining a real-time vibration feedback signal Fυ＝AF。
7. A vibration feedback method of a rehabilitation robot is characterized by comprising the following steps:
judging the muscle strength grade of the patient by a muscle strength grade judging module; the vibration feedback calculation module obtains a vibration feedback grade according to the muscle force grade and calculates a vibration signal parameter;
the event signal calculation module receives a vibration event signal from a game and calculates a real-time vibration feedback signal according to the vibration feedback grade and the vibration signal parameter of the current user;
the moment and vibration signal superposition module receives the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal, superposes the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal to form a total moment control signal, and sends the total moment control signal to the motor driver to drive the motor to generate torque.
8. A vibration feedback device of a rehabilitation robot is characterized by comprising a robot controller, wherein a training feedback module, an event signal calculation module, a moment and vibration signal superposition module and an impedance control module are integrated in the robot controller;
the training feedback module comprises a muscle strength grade judging module and a vibration feedback calculating module; judging the muscle strength grade of the patient by a muscle strength grade judging module; the vibration feedback calculation module obtains a vibration feedback grade according to the muscle force grade and calculates a vibration signal parameter;
the event signal calculation module receives a vibration event signal from a game and calculates a real-time vibration feedback signal according to the vibration feedback grade and the vibration signal parameter of the current user;
the moment and vibration signal superposition module receives the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal, superposes the real-time moment control instruction, the real-time vibration feedback signal and the modeling error compensation signal to form a total moment control signal, and sends the total moment control signal to the motor driver.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111515051.4A CN114177588B (en) | 2021-12-13 | 2021-12-13 | Vibration feedback system, method and device of rehabilitation robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111515051.4A CN114177588B (en) | 2021-12-13 | 2021-12-13 | Vibration feedback system, method and device of rehabilitation robot |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114177588A true CN114177588A (en) | 2022-03-15 |
| CN114177588B CN114177588B (en) | 2022-11-11 |
Family
ID=80604607
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111515051.4A Active CN114177588B (en) | 2021-12-13 | 2021-12-13 | Vibration feedback system, method and device of rehabilitation robot |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114177588B (en) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101582166A (en) * | 2008-05-12 | 2009-11-18 | 皇家飞利浦电子股份有限公司 | System and method for tracking target |
| EP2316543A1 (en) * | 2009-10-27 | 2011-05-04 | Michael Barth | Device for training the musculature of a person |
| US20120021872A1 (en) * | 2008-10-07 | 2012-01-26 | Louis Laurent Saha | Exercise apparatus |
| CN107320285A (en) * | 2017-07-28 | 2017-11-07 | 上海逸动医学科技有限公司 | A kind of multifunctional intellectual rehabilitation training and assessment system |
| CN107397649A (en) * | 2017-08-10 | 2017-11-28 | 燕山大学 | A kind of upper limbs exoskeleton rehabilitation robot control method based on radial base neural net |
| CN109363888A (en) * | 2018-11-14 | 2019-02-22 | 华南理工大学 | A kind of immersion rehabilitation training of upper limbs system |
-
2021
- 2021-12-13 CN CN202111515051.4A patent/CN114177588B/en active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101582166A (en) * | 2008-05-12 | 2009-11-18 | 皇家飞利浦电子股份有限公司 | System and method for tracking target |
| US20120021872A1 (en) * | 2008-10-07 | 2012-01-26 | Louis Laurent Saha | Exercise apparatus |
| EP2316543A1 (en) * | 2009-10-27 | 2011-05-04 | Michael Barth | Device for training the musculature of a person |
| CN107320285A (en) * | 2017-07-28 | 2017-11-07 | 上海逸动医学科技有限公司 | A kind of multifunctional intellectual rehabilitation training and assessment system |
| CN107397649A (en) * | 2017-08-10 | 2017-11-28 | 燕山大学 | A kind of upper limbs exoskeleton rehabilitation robot control method based on radial base neural net |
| CN109363888A (en) * | 2018-11-14 | 2019-02-22 | 华南理工大学 | A kind of immersion rehabilitation training of upper limbs system |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114177588B (en) | 2022-11-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| AU2007335256B2 (en) | Method and apparatus for haptic control | |
| Feasel et al. | LLCM-WIP: Low-latency, continuous-motion walking-in-place | |
| Boian et al. | Haptic effects for virtual reality-based post-stroke rehabilitation | |
| Rauter et al. | A tendon-based parallel robot applied to motor learning in sports | |
| Shahbazi et al. | Position-force domain passivity of the human arm in telerobotic systems | |
| CN112274865B (en) | On-demand auxiliary adaptive control method and system for lower limb rehabilitation robot | |
| KR101183823B1 (en) | Reaction force controlling system and method | |
| Dawson-Elli et al. | Design and validation of a lower-limb haptic rehabilitation robot | |
| CN114177588B (en) | Vibration feedback system, method and device of rehabilitation robot | |
| CN105824248B (en) | A kind of impedance and the haptic feedback control method based on event | |
| Ott et al. | Improving user comfort in haptic virtual environments through gravity compensation | |
| CN112827153A (en) | Active self-adaptive system for human body function training and control method thereof | |
| CN110302497B (en) | Power type sports equipment capable of changing leg sports mode | |
| Hwang et al. | ErgoPulse: Electrifying Your Lower Body With Biomechanical Simulation-based Electrical Muscle Stimulation Haptic System in Virtual Reality | |
| Jomås et al. | Computer-Based Environment for Lower Limb Neurorehabilitation and Assessment Biomechatronic System for Human Machine Interconnection through Motion Platform, Virtual Reality and Motion Capture System | |
| Dupuis et al. | Design of a sensorial and driving locomotion interface | |
| Sakaniwa et al. | Improved Tilt Feeling During Remote Control of Construction Machine by Tactile Sensation | |
| Morita et al. | Basic study on rehabilitation support system for upper limb motor function | |
| JP2008216400A (en) | Driving simulator and driving simulation method | |
| Tanaka et al. | Analysis and Modeling of Human Force Perception Properties during the Operation of a Driving Interface System Using Limbs | |
| Li et al. | Modeling and Verification of a Bimanual-Coordinated Training System | |
| CN110384932A (en) | The virtual reality system of cycling emulation | |
| JPH10258100A (en) | Ergotherapy | |
| CN116551670A (en) | Compliant control method based on training robot and readable storage medium | |
| Lu et al. | Virtually offloading body mass for rehabilitation: A simulation study |
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 | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |