Disclosure of Invention
The present invention has been made to solve the above-described problems, and an object of the present invention is to provide a household portable elbow function auxiliary device and a control method.
The invention provides a household portable elbow joint function auxiliary appliance which is characterized by comprising a power transmission mechanism, a driving mechanism, an elbow tray, an elbow motion executing mechanism, a pressure lattice tray, a front arm tray and a central control module, wherein the power transmission mechanism comprises a shell and a synchronous belt arranged in the shell, the driving mechanism comprises a driving motor connected with the synchronous belt and a current sensor connected with the driving motor and used for collecting real-time current data, the elbow tray is fixedly connected with the driving motor and used for placing an elbow, the elbow motion executing mechanism comprises a driven shaft arranged in the shell, a front arm connecting rod connected with the driven shaft, a special-shaped shaft connected with the driven shaft, a coil spring connected with the driven shaft, a cover arranged outside the coil spring and a through cover matched with the cover, the front arm connecting rod is fixedly connected with the front arm connecting rod and used for placing a front arm, the central control module is used for controlling the operation interface, the central control module comprises a central controller and a motor driver, two ends of the special-shaped shaft are respectively provided with a plane section and a rectangular boss, the plane section is connected with the angle sensor and used for monitoring a real-time rotation angle, the front arm tray is also provided with the pressure sensor, the pressure sensor is used for acquiring the target pressure position and the pressure sensor, the pressure sensor is used for acquiring the pressure information, and the pressure sensor is used for acquiring the data, and the data of the data is in communication with the central control interface, and is used for controlling the data communication and is used for carrying control.
The household portable elbow joint function auxiliary appliance provided by the invention can be further characterized in that six uniformly distributed rectangular grooves are further formed in the transparent cover, six uniformly distributed bosses are further arranged on the machine cover, the transparent cover and the machine cover are connected in a matched mode through the rectangular grooves and the bosses, the pretightening force of the coil spring is quantitatively adjusted through rotation of the transparent cover through the matched change of the rectangular grooves and the bosses, and the single rotation angle of the transparent cover is 60 degrees.
The household portable elbow joint function auxiliary appliance provided by the invention can be further characterized in that the synchronous belt is arranged around the rotating shaft and the driven shaft of the driving motor, and the driving motor drives the driven shaft to rotate through the synchronous belt so as to drive the forearm connecting rod to move.
The household portable elbow joint function auxiliary appliance provided by the invention can be further characterized in that the center of the transparent cover is also provided with the transparent cover through hole, the special-shaped shaft is also provided with the special-shaped shaft flange, the transparent cover through hole is matched with the special-shaped shaft for use, and the aperture of the transparent cover through hole is slightly larger than the diameter of the special-shaped shaft flange.
The household portable elbow joint function auxiliary appliance provided by the invention can be further characterized in that the driven shaft is further provided with a large rectangular notch, the rectangular boss is matched with the large rectangular notch for use, the driven shaft drives the special-shaped shaft to move through the large rectangular notch, so that the movement characteristics of the driven shaft and the special-shaped shaft are consistent, the angle sensor is further driven to move to measure the rotation angle, and the thickness of the rectangular boss is smaller than 1% of the opening width of the large rectangular notch.
The household portable elbow joint function auxiliary appliance can be characterized in that a groove is further formed in the penetrating cover to accommodate the coil spring, the groove is provided with a side edge bulge, one end of the coil spring is fixedly connected with the driven shaft, the other end of the coil spring is fixedly connected with the penetrating cover in the side edge bulge, the penetrating cover is rotated to adjust pretightening force of the coil spring, and different boosting effects are provided.
The household portable elbow joint function auxiliary appliance provided by the invention can be further characterized in that the pressure sensor lattice is 8 x 8 lattice, the size is 7cm x 5cm, the pressure acquisition range is 0.01N-100N, and the pressure distribution information comprises the distribution coordinate value of the pressure data acquired by the pressure sensor lattice on the arm of the patient and is used for detecting the placement position of the arm.
The invention also provides a control method of the household portable elbow joint function auxiliary appliance, which has the characteristics that:
step1, after a patient correspondingly places an arm and an elbow on an arm tray and an elbow tray, acquiring two limit movement positions of the arm during movement as safety position data through an angle sensor;
Step 2, transmitting the safety position data communication to a central controller, and carrying out safety limit by the central controller according to the limit movement position to limit the movement range of the forearm connecting rod;
Step 3, a passive teaching mode or an active power assisting mode is selected through an operation panel to perform rehabilitation training, data of a current sensor, an acceleration sensor, an angular velocity sensor and a pressure sensor lattice are collected in real time in the training process, a central controller performs fuzzy reasoning according to a given fuzzy rule based on the collected data, finally deblurs fuzzy parameters, outputs cascade PID control parameters, and the central controller sends out a control instruction to control a driving motor through a motor driver so that an elbow motion executing mechanism performs corresponding rehabilitation motion;
step 4, after the training period is finished, the driving motor stops running,
In step 2, the central controller performs safety limit according to the limit movement position, and in the rehabilitation training process, the movement position of the forearm connecting rod cannot exceed the limit movement position, and the formula of the movement range of the forearm connecting rod is as follows:
θhigh>θreal>θlow (1)
In the formula (3), θ real is the movement angle of the forearm link, θ high is the highest movement position of the forearm link, and θ low is the lowest movement position of the forearm link.
The control method of the household portable elbow joint function auxiliary appliance provided by the invention can be characterized in that the method comprises the following steps after a passive teaching mode is selected in the step 3:
A1, when a passive teaching mode is selected, a central controller enters state data acquisition, and a driving motor is in a standby state;
a2, a rehabilitation doctor brings a patient to complete a set of rehabilitation training exercise, and in the rehabilitation training exercise process, the exercise process state data of the driving motor is sampled and recorded in real time through the acceleration sensor and the angular velocity sensor and is transmitted to the central controller for storage;
A3, after the rehabilitation training exercise of the patient is finished, the rehabilitation doctor takes the patient, the record is selected to stop through the operation panel, the central controller stops the state data acquisition, and the central controller correspondingly controls the driving motor to reproduce the rehabilitation training exercise through the motor driver according to the stored exercise process state data;
And step A4, the central controller adjusts fuzzy PID parameters according to the motion process state data and outputs corresponding motor control signals, and the motor driver transmits the motor control signals to the driving motor through the Modbus to reproduce rehabilitation training motions.
The control method of the household portable elbow joint function auxiliary appliance provided by the invention can be characterized in that in the step 3, after the active assistance mode is selected, the control method specifically comprises the following steps:
step B1, when an active power assisting mode is selected, the central controller sets a preset power assisting value, the preset power assisting value is determined through an operation panel, power assisting directions are set according to different conditions of muscle tension of a patient, buckling power assisting and stretching power assisting are respectively carried out on the patient, elbow joint buckling or stretching movement is assisted, and a driving motor is in a standby state;
Step B2, after the preset assistance value is set, the central controller generates a control signal according to the preset assistance value and controls a driving motor to provide corresponding assistance through a motor driver, the driving motor drives a forearm connecting rod to move to provide corresponding assistance for rehabilitation training movement of a patient, and in the rehabilitation training movement process, a pressure sensor lattice, a current sensor, an angle sensor and an acceleration sensor start to acquire movement state data of the device in real time and transmit the movement state data to the central controller;
step B3, the central controller calculates the current assisting moment of the driving motor according to the current data acquired by the current sensor, adjusts and determines the assisting position coordinate point according to the target position pressure information and the movement range of the forearm connecting rod, calculates the pulse frequency sent by the assisting moment of the driving motor, adjusts the fuzzy PID parameter in real time by adopting a fuzzy PID control algorithm to adjust the pulse frequency, outputs a corresponding control signal to correspondingly adjust the assisting moment of the driving motor, stabilizes the assisting force provided by the driving motor to approach to a preset assisting value by stabilizing the size of the pressure data,
In step B3, when determining the coordinate point of the assistance position, determining the coordinate position, the pressure data size and the variation trend of the pressure main action point according to the pressure information of the target position, specifically including:
According to the target position pressure information, selecting a maximum pressure action point as a main pressure action point, and according to the coordinate information and the numerical information of the main pressure action point, adjusting the movement position of the forearm connecting rod to enable the main pressure action point to meet the following conditions:
In the formula (2), F is the magnitude of the pressure value, G is the coordinate position of the main pressure action point,
The output formula of the pulse frequency is as follows:
OUTPUT=Kp1*Freal+Kd*(Preal-Pbias)'-Kp1*[Kp2*(Vreal-Vbias)+Ki*∑(Vreal-Vbias)] (3).
Effects and effects of the invention
According to the household portable elbow joint function auxiliary appliance and the control method, different preset assistance values can be set according to different patients in an active assistance mode to guide the patients to actively conduct elbow joint bending and stretching movements, elbow joint states of the patients are monitored in real time in the assistance process, the movement states of the elbow movement actuating mechanism are adjusted in real time by adjusting control parameters of the driving motor in real time, the household portable elbow joint function auxiliary appliance can be suitable for different patients and disturbance changes under different conditions, corresponding assistance is stably provided to assist rehabilitation movements of the patients, and the household portable elbow joint function auxiliary appliance is small in size, light in weight, capable of being popularized to family use, effectively improving practicality and portability of rehabilitation equipment, convenient for rehabilitation training of the patients in different scenes, and beneficial to market popularization and use.
Detailed Description
In order to make the technical means and effects of the present invention easy to understand, the present invention will be specifically described with reference to the following examples and the accompanying drawings.
< Example >
Fig. 1 is a schematic view showing a structure of a household portable elbow joint function auxiliary appliance according to an embodiment of the present invention.
As shown in fig. 1, a household portable elbow joint function auxiliary appliance 100 of the present embodiment includes a power transmission mechanism 10, a driving mechanism 20, an elbow tray 30, an elbow movement executing mechanism 40, a forearm tray 50, and a central control module (not shown).
Fig. 2 is a schematic structural view of a power transmission mechanism in an embodiment of the invention.
As shown in fig. 2, the power transmission mechanism 10 includes a housing 11 and a timing belt 12 provided in the housing.
The drive mechanism 20 includes a drive motor 21 connected to the timing belt 12 and a current sensor 22 connected to the drive motor 21 for acquiring real-time current data.
The elbow tray 30 is fixedly connected with the driving motor 21 and is used for placing an elbow.
Fig. 3 is a schematic structural view of an elbow motion actuator according to an embodiment of the present invention, fig. 4 is a schematic structural view of a perspective cover mated with a cover according to an embodiment of the present invention, fig. 5 is a schematic structural view of a perspective cover according to an embodiment of the present invention, and fig. 6 is a schematic structural view of a connection structure of a driven shaft and a contoured shaft according to an embodiment of the present invention.
As shown in fig. 3 to 6, the elbow motion actuator 40 includes a driven shaft 41 provided in the housing 11, a forearm link 42 connected to the driven shaft 41, a shaped shaft 43 connected to the driven shaft 41, a coil spring 44 connected to the driven shaft 43, a cover 45 provided outside the coil spring 44, and a through cover 46 cooperatively connected to the cover 45.
Six rectangular grooves 461 which are uniformly distributed are also arranged on the transparent cover 46, six bosses 451 which are uniformly distributed are also arranged on the machine cover 45, the transparent cover 46 and the machine cover 45 are connected in a matched way through the rectangular grooves 461 and the bosses 451,
The penetrating cover 46 is rotated by the cooperation of the rectangular slot 461 and the boss 451 to quantitatively adjust the pretightening force of the coil spring 44, and the single rotation angle of the penetrating cover 46 is 60 °.
The center of the through cover 46 is also provided with a through cover through hole 462, the shaped shaft 43 is also provided with a shaped shaft flange 431,
The through-cover through hole 462 is matched with the special-shaped shaft 43, and the aperture of the through-cover through hole 462 is slightly larger than the diameter of the special-shaped shaft flange 431.
The penetrating cover 46 is also internally provided with a groove 463 for accommodating the coil spring 44, the groove 463 is provided with a side edge bulge, one end of the coil spring 44 is fixedly connected with the driven shaft 43, the other end of the coil spring 44 is fixedly connected with the penetrating cover 46 in the side edge bulge, and the pretightening force of the coil spring 44 is regulated by rotating the penetrating cover 46, so that the boosting effect with different sizes is provided.
An acceleration sensor 60 is also provided at the driven shaft 41 for acquiring rotational speed.
Both ends of the irregular shaft 43 are respectively provided with a flat cut surface 432 and a rectangular boss 433, and the flat cut surface 432 is connected with an angular velocity sensor 70 for monitoring the rotation angle in real time.
The driven shaft 41 is also provided with a large rectangular notch 411, the rectangular lug 433 is matched with the large rectangular notch 411, the driven shaft 41 drives the special-shaped shaft 43 to move through the large rectangular notch 411, so that the movement characteristics of the driven shaft 41 and the special-shaped shaft 43 are consistent, and the angle sensor 70 is further driven to move to measure the rotation angle,
The thickness of the rectangular boss 433 is smaller than 1% of the opening width of the large rectangular cutout 411, so that the rectangular boss 433 is more smoothly fitted with the large rectangular cutout 411.
The forearm tray 50 is fixedly connected to the forearm link 42 for positioning the forearm.
The forearm tray 50 is further provided with a pressure sensor lattice 80 for acquiring pressure information of a target position, including pressure distribution information of the contact surface of the arm and the arm tray of the patient, and the size and pressure data change trend of the pressure data.
The timing belt 12 is disposed around the rotation shaft 211 and the driven shaft 41 of the driving motor 21, and the driving motor 21 drives the driven shaft 41 to rotate through the timing belt 12 to drive the forearm link 42 to move.
And the central control module is used for controlling and comprises an operation interface, a central controller and a motor driver.
The current sensor 22, the acceleration sensor 60, the angular velocity sensor 70 and the pressure sensor array 80 are all communicatively connected to the central controller to transmit the collected data to the central controller for data processing, and the data is displayed on an operation interface,
The motor driver is connected to the drive motor 21 via a Modbus bus for controlling the drive motor 21.
FIG. 7 is a schematic diagram of a pressure sensor array in an embodiment of the invention.
As shown in fig. 7, the pressure sensor lattice 80 is an 8 x 8 lattice, the size is 7cm x 5cm, the pressure acquisition range is 0.01 n-100 n,
The pressure distribution information comprises distribution coordinate values of pressure data acquired by the pressure sensor lattice on the arm of the patient, and the distribution coordinate values are used for detecting whether the placement position of the arm is correct or not.
The control method of the household portable elbow joint function auxiliary appliance of the embodiment comprises the following steps:
in step 1, after the patient places the arm and the elbow in the arm tray 50 and the elbow tray 30, two limit movement positions when the arm moves are acquired as the safety position data by the angle sensor 70.
And step 2, transmitting the safety position data to a central controller, and carrying out safety limit according to the limit movement position by the central controller to limit the movement range of the forearm connecting rod 42.
In step 2, the central controller performs safety limit according to the limit movement position, and in the rehabilitation training process, the movement position of the forearm connecting rod cannot exceed the limit movement position, and the formula of the movement range of the forearm connecting rod is as follows:
θhigh>θreal>θlow (1)
In the formula (3), θ real is the movement angle of the forearm link, θ high is the highest movement position of the forearm link, and θ low is the lowest movement position of the forearm link.
And 3, selecting a passive teaching mode or an active power assisting mode through an operation panel to perform rehabilitation training, collecting data of the current sensor 22, the acceleration sensor 60, the angular velocity sensor 70 and the pressure sensor lattice 80 in real time in the training process, performing fuzzy reasoning according to a given fuzzy rule by a central controller based on the collected data, defuzzifying fuzzy parameters finally, outputting cascade PID control parameters, and sending a control instruction by the central controller, wherein the central controller controls the driving motor 21 to enable the elbow motion executing mechanism 40 to perform corresponding rehabilitation actions.
Fig. 8 is a control block diagram of the central controller in the embodiment of the present invention.
As shown in fig. 8, the central controller is provided with a CPU to perform operation and send a corresponding control instruction, and controls the driving motor 21 to perform movement through the motor driver, so as to control the elbow movement executing mechanism 40 to perform corresponding rehabilitation actions, and based on the data collected in real time by the current sensor 22, the acceleration sensor 60, the angular velocity sensor 70 and the pressure sensor lattice 80 in the rehabilitation training process, performs fuzzy reasoning according to a given fuzzy rule, and finally deblurs the fuzzy parameters, and outputs cascade PID control parameters to control the driving motor 21 to perform corresponding actions.
Fig. 9 is a block diagram of fuzzy PID control in an embodiment of the present invention, and fig. 10 is a block diagram of cascade PID control in an embodiment of the present invention.
As shown in fig. 9 and 10, the central controller is further provided with a fuzzy controller and a cascade PID controller to perform fuzzy PID control, the central controller performs fuzzy reasoning according to a given fuzzy rule through the fuzzy controller based on data collected in real time by a rehabilitation training data monitoring device formed by the current sensor 22, the acceleration sensor 60, the angular velocity sensor 70 and the pressure sensor lattice 80, and finally deblurs fuzzy parameters to output cascade PID control parameters to the cascade PID controller, in the cascade PID control, the outer ring is a velocity PI controller, the inner ring is a pressure PD controller, and the elbow motion executing mechanism 40 is ensured to execute corresponding actions according to control instructions through the cascade PID control.
In step 3, after the passive teaching mode is selected, the method specifically comprises the following steps:
step A1, when a passive teaching mode is selected, the central controller enters state data acquisition, and the driving motor 21 is in a standby state;
Step A2, a rehabilitation doctor takes a patient to complete a set of rehabilitation training exercise, and in the rehabilitation training exercise process, the exercise process state data of the driving motor 21 are sampled and recorded in real time through the acceleration sensor 60 and the angular velocity sensor 70 and are transmitted to the central controller for storage;
Step A3, after the rehabilitation training exercise of the patient is finished, the rehabilitation doctor takes the patient to select to stop recording through the operation panel, the central controller stops collecting state data, and the central controller correspondingly controls the driving motor 21 through the motor driver according to the stored exercise process state data to reproduce the rehabilitation training exercise;
and step A4, the central controller adjusts fuzzy PID parameters according to the motion process state data and outputs corresponding motor control signals, and the motor driver transmits the motor control signals to the driving motor 21 through a Modbus bus to reproduce rehabilitation training motions.
In step 3, after the active power assisting mode is selected, the method specifically comprises the following steps:
Step B1, when the active power assisting mode is selected, the central controller sets a preset power assisting value, determines the preset power assisting value through the operation panel, sets power assisting directions according to different conditions of muscle tension of a patient, respectively assisting the patient in elbow joint buckling or stretching, and drives the motor 21 to be in a standby state;
Step B2, after the preset assistance value is set, the central controller generates a control signal according to the preset assistance value and controls the driving motor 21 to provide corresponding assistance through the motor driver, the driving motor 21 drives the forearm connecting rod 42 to move to provide corresponding assistance for rehabilitation training movement of a patient, and in the rehabilitation training movement process, the pressure sensor lattice 80, the current sensor 22, the angle sensor 70 and the acceleration sensor 60 start to acquire device movement state data in real time and transmit the device movement state data to the central controller;
Step B3, the central controller calculates the current assisting moment of the driving motor 21 according to the current data acquired by the current sensor 22, adjusts and determines the assisting position coordinate point and calculates the pulse frequency sent by the assisting moment of the driving motor 21 according to the target position pressure information and the movement range of the forearm connecting rod 42, the central controller adjusts the fuzzy PID parameter in real time by adopting a fuzzy PID control algorithm to adjust the pulse frequency and outputs a corresponding control signal to correspondingly adjust the assisting moment of the driving motor 21, the assisting force provided by the driving motor 21 is stabilized to approach to a preset assisting value by stabilizing the size of the pressure data,
In step B3, when determining the coordinate point of the assistance position, determining the coordinate position, the pressure data size and the variation trend of the pressure main action point according to the pressure information of the target position, specifically including:
As shown in fig. 7, according to the target position pressure information, the maximum pressure action point is selected as the main pressure action point, and according to the coordinate information and the numerical information of the main pressure action point, the movement position of the forearm link is adjusted so that the main pressure action point satisfies:
In the formula (2), F is the magnitude of the pressure value, G is the coordinate position of the main pressure action point,
The output formula of the pulse frequency is as follows:
OUTPUT=Kp1*Freal+Kd*(Preal-Pbias)'-Kp1*[Kp2*(Vreal-Vbias)+Ki*∑(Vreal-Vbias)] (3).
And 4, after the training period is finished, the driving motor 21 stops running.
Effects and effects of the examples
According to the household portable elbow joint function auxiliary appliance and the control method, different preset assistance values can be set according to different patients in an active assistance mode to guide the patients to actively conduct elbow joint bending and stretching movements, elbow joint states of the patients are monitored in real time in the assistance process, the movement states of the elbow movement executing mechanism are adjusted in real time by adjusting control parameters of the driving motor in real time, the household portable elbow joint function auxiliary appliance can be suitable for different patients and disturbance changes under different conditions, corresponding assistance is stably provided to assist rehabilitation movements of the patients, and the household portable elbow joint function auxiliary appliance is small in size, light in weight, capable of being popularized to families, effectively improving practicality and portability of rehabilitation equipment, convenient for rehabilitation training of the patients in different scenes, and beneficial to market popularization and use.
The above embodiments are preferred examples of the present invention, and are not intended to limit the scope of the present invention.