Lower limb training robot wheel-leg coordination control method based on gait time phase and lower limb training robot
By constructing a step-length step prediction model and using admittance control method, the problem of human-machine dissonance in the wheeled lower limb training robot during walking training is solved, efficient lower limb training is achieved, and the patient's walking flexibility and gait are improved. Coordination.
Patent Information
- Application Number
- CN202410978135.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-22
- Publication Date
- 2024-11-08
Smart Images

Figure CN118903792A_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of lower limb training robots, and in particular relates to a wheel-leg coordination control method of a lower limb training robot based on gait phase and a lower limb training robot. Background Art
[0002] With the increasing aging of the population, more and more elderly people have lost the ability to stand and walk independently in their lower limbs due to stroke, cardiovascular disease and other reasons, which has brought great inconvenience to their daily lives and greatly reduced their quality of life. They need to use external equipment for lower limb walking rehabilitation training. The existing wheeled lower limb training robots and rehabilitation wearable devices can provide support and walking training for patients. The walking training is carried out by the patient driving the lower limb training robot to move or the lower limb training robot drives the patient to move. No matter which method is used, the patient is prone to human-machine coordination problems during the walking training process. Since the human body's motion trajectory is difficult to accurately predict and control, the flexibility between the human and the machine is low and the patient's comfort during training is reduced. In addition, some traditional rehabilitation robots mostly only drive patients to walk, and it is difficult to effectively train patients with damaged lower limb joint muscles, and cannot help patients improve leg strength and gait. Summary of the invention
[0003] In order to solve the above technical problems, the present invention provides a wheel-leg coordination control method of a lower limb training robot based on gait phase, which predicts movement intention and thus improves the flexibility and coordination of human-computer interaction, and a lower limb training robot.
[0004] Based on the above purpose, the present invention is achieved through the following technical solutions:
[0005] A method for coordinating wheel-leg control of a lower limb training robot based on gait phase, wherein the lower limb training robot comprises a wheeled mobile platform for executing the movement of the robot, wherein the wheeled mobile platform comprises two bottom wheels at the front and rear, and the wheeled mobile platform is connected to the upper pelvic mechanism through a weight reduction system, and the left and right sides of the pelvic mechanism are provided with exoskeleton mechanical legs, and the exoskeleton mechanical legs are built with exoskeleton motors, and the exoskeleton mechanical legs are controlled by an admittance control method to follow the leg movement of the human body; the method comprises the following steps:
[0006] Step 1: collect the gait parameters of human walking through experiments, use the gait parameters as input for simulation analysis to obtain the gait change data of human walking, combine the stance phase and swing phase of the human gait cycle, build a step length and speed prediction model, and fit the change curves of joint angle, step length and speed during walking; the gait parameters include the real-time position, speed and acceleration information of human walking.
[0007] Step 2: The next step speed change of the human body is predicted and generated according to the step length and speed prediction model. At the same time, the admittance control method is used to control the exoskeleton mechanical legs of the lower limb training robot to follow the leg movement of the human body. The exoskeleton mechanical legs apply a certain leg lifting resistance to the human leg according to the next step gait parameters generated by the step length and speed prediction model.
[0008] Step 3: According to the change in the next step speed of the human body generated in step 2, the PI control algorithm is used to control the movement of the bottom wheels of the lower limb training robot, so that the walking speed and gait of the lower limb training robot are consistent with those of the human body, thereby realizing coordinated control of the wheels and legs of the lower limb training robot and the human body.
[0009] According to the above-mentioned wheel-leg coordinated control method of the lower limb training robot based on gait phase, preferably, in step 1, the step of obtaining the joint angle change data is: using the motion capture system on the lower limb training robot to collect the displacement coordinate change data of the human body during walking, performing inverse kinematics simulation and solving the collected coordinate data to obtain the joint angle change data; fitting the relationship between the obtained joint angle data and the gait cycle, and establishing the joint angle change curve;
[0010] The change data of the joint angle is:
[0011]
[0012] The element calculation formula of the Jacobian matrix is:
[0013]
[0014] Among them, p i Represents the i-th coordinate component (x, y or z) of the lower limb walking mark point; q j represents the j joint angles; J ij Represents the effect of a small change in each joint angle on the change in the marker position.
[0015] According to the above-mentioned wheel-leg coordination control method for lower limb training robot based on gait phase, preferably, in step 1, the step of fitting the joint angle change curve is: analyzing the change data of the joint angle in combination with the gait cycle to obtain the change curve of the joint angle, and fitting the change curve of the joint angle in the form of a sine function:
[0016]
[0017] Among them, A q is the amplitude, which is used to indicate the magnitude of change in the joint angle; T represents the length of the gait cycle; Indicates the phase offset, which is used to adjust the starting phase of the function; B indicates the vertical offset, which is used to adjust the baseline of the function;
[0018] The change curve of joint angle is obtained by combining multiple sine functions:
[0019]
[0020] Where n is the number of sine functions, Represents the phase offset of n sine functions, B n Indicates the vertical offset of n sine functions.
[0021] According to the above-mentioned wheel-leg coordination control method for lower limb training robot based on gait phase, preferably, in step 1, the step length is calculated according to the maximum leg angle and leg length when the human body walks, and the calculation formula of the step length is:
[0022]
[0023] Among them, L step Indicates step length; L l Indicates long legs; It indicates the angle at which the hip joint drives the front leg to swing; Indicates the angle at which the hip joint drives the hind leg to swing.
[0024] According to the above-mentioned wheel-leg coordinated control method for lower limb training robots based on gait phase, preferably, in step 1, the step length is regarded as a periodic change, which is affected by the gait cycle, the maximum angle change of the legs when the human body walks, and the length of the human legs. The step length change curve is obtained by fitting in the form of a sine function:
[0025]
[0026] Among them, A is the amplitude of the step length, which indicates the range of change of the step length; T represents the gait cycle; represents the phase offset; k represents the coefficient that adjusts the influence of the maximum leg angle change on the step length; M represents the maximum leg angle change; M max Indicates the maximum possible change in the leg angle.
[0027] According to the above-mentioned wheel-leg coordination control method for a lower limb training robot based on gait phase, preferably, in step 2, the pace is the change in the speed of the human body in the forward direction, and the step of generating the pace using the step length and pace prediction model is:
[0028] V step (t i )=L step (t i )×f step (t i );
[0029] Among them, Vstep Indicates the pace, L step represents the step length, f step Indicates the cadence;
[0030] By monitoring the changes in the stride length and frequency of the human body in different gait phases, the change in the speed of the human body's next step is generated. According to the change in the speed in the forward direction, the rotation speed and motion parameters of the robot's wheel legs are adjusted to match the walking speed and gait of the human body; ensuring that the robot can adapt to the walking speed of the human body and maintain coordination with the human body's gait.
[0031] According to the above-mentioned wheel-leg coordinated control method of the lower limb training robot based on gait phase, preferably, in step 2, the step frequency is calculated according to the support phase and swing phase of the human gait and the gait cycle determined by the sensor on the lower limb training robot; the support phase is the stage from heel landing to toe leaving the ground; the swing phase is the stage from toe leaving the ground to heel landing;
[0032] According to the changing rules of the support phase and the swing phase in different gait phases, the exoskeleton mechanical legs of the lower limb training robot are used to apply a certain resistance to leg lifting during the swing phase when the human body lifts its legs, which is used for the patient's lower limb muscle strength training.
[0033] The steps of applying resistance to leg lifting by the exoskeleton mechanical leg are: start - determine the time phase - whether to enter the swing phase - yes, the exoskeleton mechanical leg applies resistance - whether to enter the support phase - yes, the exoskeleton mechanical leg stops applying resistance - return to continue determining the time phase; the exoskeleton mechanical leg is controlled by an admittance control method, detects the end force, adjusts the end speed, and applies appropriate resistance.
[0034] According to the above-mentioned wheel-leg coordination control method of the lower limb training robot based on gait phase, preferably, in step 3, the control method of the bottom wheel movement is: calculating the expected rotation speed of the bottom wheel according to the predicted change of the next step speed of the human body, and using the PI control algorithm to control the bottom wheel to rotate at the expected rotation speed; the calculation formula of the bottom wheel movement is:
[0035] e dl (t) = ω e (t)-ω n (t);
[0036]
[0037] ω dl =ω n (t)+σ dl (t);
[0038] Among them, e dl Indicates the error between the target speed and the actual speed of the bottom wheel; ω e represents the expected speed; ωn Indicates the current speed; σ dl Indicates the adjustment amount of the bottom wheel forward speed calculated according to PI control; K p Represents proportional gain; K i represents the integral gain; ω dl Indicates the forward speed of the bottom wheel at the next moment;
[0039] When calculating the current speed ω of the bottom wheel, first determine the speed ω of the bottom wheel at the previous moment t-1 Whether it exceeds the predicted speed value. If it exceeds the predicted value, only the negative deviation is accumulated. If it does not exceed the predicted value, the positive deviation is accumulated.
[0040] A lower limb training robot using the above-mentioned gait phase-based wheel-leg coordinated control method for a lower limb training robot includes a wheeled mobile platform for executing robot movement and assisting patients in walking training. The wheeled mobile platform includes two bottom wheels at the front and rear, and the wheeled mobile platform is connected to a pelvic mechanism above the wheeled mobile platform through a weight reduction system. Exoskeleton mechanical legs are symmetrically arranged on the left and right sides of the pelvic mechanism. The exoskeleton mechanical legs have built-in exoskeleton motors, and the exoskeleton mechanical legs are connected to the pelvic mechanism through support arms on the left and right sides.
[0041] Preferably, the wheeled mobile platform is connected to the weight reduction system through the longitudinal support platforms on the left and right sides, the weight reduction system is connected to the pelvic mechanism through a ball screw, and the exoskeleton mechanical legs are fixedly connected to the pelvic mechanism; a control cabinet is provided on the wheeled mobile platform; the exoskeleton mechanical legs provide power to assist the human body in walking, and can also apply a certain amount of leg lifting resistance when walking, which is used for the patient's lower limb muscle strength training; the weight reduction system is used to control the movement of the body's center of gravity in the vertical plane, and the weight reduction system transmits power to the pelvic mechanism through a ball screw, provides support for the human body, and reduces the pressure on the soles of the human body.
[0042] Compared with the prior art, the present invention has the following beneficial effects:
[0043] 1. The present invention collects human gait parameter data, fits the joint angle, step length and step speed curves according to the gait change data and the step length and speed prediction model, adopts the admittance control method to control the exoskeleton mechanical legs, and applies a certain resistance to the human legs through the exoskeleton mechanical legs during training. The bottom wheels of the wheeled mobile platform are controlled by the PI control algorithm to make the wheeled mobile platform adapt to the walking trajectory of the human body. The control method of the present invention is simple, easy to operate, efficient and accurate.
[0044] 2. The present invention uses the support phase, swing phase and gait parameters, step length and speed prediction model in the gait phase, adopts the admittance control method to control the exoskeleton mechanical legs, and uses the PI control algorithm to control and adjust the problem of uncoordinated human-computer interaction during rehabilitation training walking; fully utilizes the gait phase to predict the movement intention of human walking, and organically combines it with the exoskeleton mechanical legs and bottom wheel control, so as to ensure that the patient can achieve coordination and flexibility of human-computer interaction during walking training.
[0045] 3. The present invention modifies the input error value of the bottom wheel PI controller according to the relationship between the expected moving speed of the wheeled platform and the actual movement of the legs. The input PI error is the error adjustment coefficient between the target moving speed and the actual moving speed. When the adjustment coefficient is a positive value, that is, the speed in the actual forward direction is greater than the predicted expected speed, the actual error is converted into a coordination error, which is manifested in the controller as the actual speed exceeding the expected tracking speed. In this case, the output speed will be increased to ensure tracking, thereby maintaining human-machine coordination consistency. On the contrary, when the adjustment coefficient is a negative value, that is, the speed in the actual forward direction is less than the predicted expected speed, the actual error is converted into a coordination error, which is manifested in the controller as the expected speed exceeding the actual speed. In this case, the output speed will be reduced to maintain the patient's walking and coordinated movement with the rehabilitation robot.
[0046] 4. The present invention utilizes the admittance control method to control the exoskeleton mechanical legs, predicts whether the patient will be in the swing phase at the next moment based on the gait phase, and applies leg-lifting resistance in combination with gait parameters such as the leg-lifting angle, and provides resistance to the patient by changing the damping coefficient and the spring coefficient; when the leg speed increases, in order to improve muscle strength training and increase human-computer interaction, necessary muscle strength training is performed on the patient while improving wheel-leg coordination.
[0047] 5. The present invention collects walking data of the human body through experiments, and generates an expected trajectory by fitting gait parameters. The lower limb training robot determines the forward speed at the next moment according to the predefined trajectory generated by the initial gait parameters, thereby enhancing the coordination between man and machine, avoiding poor flexibility problems such as lag of the bottom wheels or legs during walking training in which the patient interacts with the lower limb training robot, improving the coordination relationship between the two, and improving the flexibility of the patient in using the lower limb training robot; the exoskeleton mechanical leg applies a certain leg-lifting resistance to the patient according to the change law of the joint angle when the patient walks, thereby enhancing the patient's muscle strength training. BRIEF DESCRIPTION OF THE DRAWINGS
[0048] Figure 1 is a schematic structural diagram of a lower limb training robot used in the present invention;
[0049] Figure 2 It is a schematic diagram of gait phases;
[0050] Figure 3 It is a schematic diagram of the gait parameter model related to human walking;
[0051] Figure 4 It is a schematic diagram of the process of applying resistance by the exoskeleton mechanical leg;
[0052] Figure 5 It is a flow chart of the PI control algorithm controlling the movement of the bottom wheel.
[0053] Among them, there are a host computer tablet 1, a weight reduction system 2, a pelvic mechanism 3, an exoskeleton mechanical leg 4, a control cabinet 5, and a wheeled mobile platform 6. DETAILED DESCRIPTION
[0054] The present invention is further described in detail below through specific examples, but the scope of the present invention is not limited thereto.
[0055] Example 1
[0056] A method for wheel-leg coordination control of a lower limb training robot based on gait phase, the method using a lower limb training robot such as Figure 1 As shown, it includes a wheeled mobile platform 6, an exoskeleton mechanical leg 4 and a weight loss system 2. The wheeled mobile platform 6 is mainly composed of a bottom wheel, a universal caster, a driver, an electrical board and other mechanisms; it is the basis for the autonomous movement of the lower limb training robot, and assists the patient in walking training; the exoskeleton mechanical leg 4 is connected to the pelvic mechanism 3 through the left and right support arms, and the exoskeleton mechanical leg 4 has a built-in drive motor, and the motor drives the leg connector; the exoskeleton mechanical leg 4 provides assistance to assist the patient in walking, and at the same time applies a certain leg lifting resistance when walking, which is used for the patient's lower limb muscle strength training; the weight loss system 2 is mainly composed of an upper computer tablet 1, a ball screw, a weight loss system 2, a drive motor and the like; the weight loss system 2 controls the movement of the body's center of gravity in the vertical plane, and the weight loss system 2 transmits power to the pelvic mechanism 3 through the ball screw, provides human body support, and reduces the patient's foot pressure. The entire lower limb training robot is based on a wheeled mobile platform 6, which is connected to the weight reduction system 2 through the longitudinal support platforms on the left and right sides. The weight reduction system 2 is connected to the pelvic mechanism 3 through a ball screw, and the exoskeleton mechanical leg 4 is fixedly connected to the pelvic mechanism 3; the lower limb training robot also includes sensors for collecting position, speed and angle information.
[0057] The steps include:
[0058] Step 1: Collect the gait parameters of human walking. The angle sensor and motor encoder on the lower limb training robot are used to collect the motion data of the human body. The real-time position, speed and acceleration of walking are used as input for simulation analysis to obtain the gait change data of the human body when walking. Then, the step length and speed prediction model is constructed by combining the stance phase and swing phase of the human gait cycle. Figure 3As shown, the change curves of joint angle, step length and speed during walking are obtained by fitting the step length and speed prediction model; the gait parameters include the real-time position, speed and acceleration information of the human body walking.
[0059] Step 101: The steps of obtaining the joint angle change data are as follows: using the motion capture system on the lower limb training robot to collect the displacement coordinate change data of the human body during walking, performing inverse kinematics simulation on the collected coordinate data to obtain the joint angle change data; fitting the relationship between the obtained joint angle data and the gait cycle to establish the joint angle change curve;
[0060] The change data of the joint angle is:
[0061]
[0062] The element calculation formula of the Jacobian matrix is:
[0063]
[0064] Among them, p i Represents the i-th coordinate component (x, y or z) of the lower limb walking mark point; q j represents the j joint angles; J ij Represents the effect of a small change in each joint angle on the change in the marker position.
[0065] Step 102: The step of fitting the joint angle change curve is: analyzing the change data of the joint angle in combination with the gait cycle to obtain the change curve of the joint angle, and fitting the change curve of the joint angle in the form of a sine function:
[0066]
[0067] Among them, A q is the amplitude, which is used to indicate the magnitude of change in the joint angle; T represents the length of the gait cycle; Indicates the phase offset, which is used to adjust the starting phase of the function; B indicates the vertical offset, which is used to adjust the baseline of the function;
[0068] The change curve of joint angle is obtained by combining multiple sine functions:
[0069]
[0070] Where n is the number of sine functions, Represents the phase offset of n sine functions, B n Indicates the vertical offset of n sine functions.
[0071] Step 103: The step length is calculated according to the maximum angle and leg length of the human body when walking. The calculation formula of the step length is:
[0072]
[0073] Among them, L step Indicates step length; L l Indicates long legs; It indicates the angle at which the hip joint drives the front leg to swing; Indicates the angle at which the hip joint drives the hind leg to swing.
[0074] Step 104: The step length is regarded as a periodic change, which is affected by the gait cycle, the maximum angle change of the legs when the human body walks, and the length of the human legs. A step length change curve is obtained by fitting in the form of a sine function:
[0075]
[0076] Among them, A is the amplitude of the step length, which indicates the range of change of the step length; T represents the gait cycle; represents the phase offset; k represents the coefficient that adjusts the influence of the maximum leg angle change on the step length; M represents the maximum leg angle change; M max Indicates the maximum possible change in the leg angle.
[0077] Step 2: The step length and speed prediction model is used to predict the next step speed change of the human body, and the admittance control method is used to control the exoskeleton mechanical leg 4 to follow the leg movement of the human body. The exoskeleton mechanical leg 4 applies a certain leg lifting resistance to the human leg according to the next step gait parameters generated by the step length and speed prediction model, which is used for the patient's muscle strength training.
[0078] Step 201: The walking speed is the change in the speed of the human body in the forward direction. The steps of generating the walking speed using the step length and walking speed prediction model are as follows:
[0079] V step (t i )=L step (t i )×f step (t i )(7);
[0080] Among them, V step Indicates the pace, L step represents the step length, f step Indicates the cadence;
[0081] By monitoring the changes in the stride length and frequency of the human body in different gait phases, the change in the speed of the human body's next step is generated. According to the change in the speed in the forward direction, the rotation speed and motion parameters of the robot's wheel legs are adjusted to match the walking speed and gait of the human body; ensuring that the robot can adapt to the walking speed of the human body and maintain coordination with the human body's gait.
[0082] Step 202: the step frequency is calculated based on the support phase and swing phase of the human gait and the gait cycle determined by the sensors on the lower limb training robot; the support phase is the stage from heel strike to toe lift-off; the swing phase is the stage from toe lift-off to heel strike;
[0083] Step 203: According to the changing rules of the support phase and the swing phase in different gait phases, Figure 2 As shown, in the swing phase when the human body lifts the leg, the exoskeleton mechanical leg 4 is used to apply a certain leg-lifting resistance for the patient's lower limb muscle strength training;
[0084] like Figure 4 As shown, the steps of the exoskeleton mechanical leg 4 applying resistance to leg lifting are: start - determine the phase - whether to enter the swing phase - yes, the exoskeleton mechanical leg 4 applies resistance - whether to enter the support phase - yes, the exoskeleton mechanical leg 4 stops applying resistance - return to continue determining the phase; the exoskeleton mechanical leg 4 is controlled by the admittance control method, detects the end force, adjusts the end speed, and applies appropriate resistance.
[0085] Step 3: According to the change in the next step speed of the human body generated in step 2, the PI control algorithm is used to control the movement of the bottom wheels of the lower limb training robot, so that the walking speed and gait of the lower limb training robot are consistent with those of the human body, thereby realizing coordinated control of the wheels and legs of the lower limb training robot and the human body.
[0086] Step 301: Figure 5 As shown, the control method of the bottom wheel movement is: calculate the expected rotation speed of the bottom wheel according to the predicted change of the next step speed of the human body, and use the PI control algorithm to control the bottom wheel to rotate at the expected rotation speed; the calculation formula of the bottom wheel movement is:
[0087] e dl (t) = ω e (t)-ω n (t)(8);
[0088]
[0089] ω dl =ω n (t)+σ dl (t)(10);
[0090] Among them, e dlIndicates the error between the target speed and the actual speed of the bottom wheel; ω e represents the expected speed; ω n Indicates the current speed; σ dl Indicates the adjustment amount of the bottom wheel forward speed calculated according to PI control; K p Represents proportional gain; K i represents the integral gain; ω dl Indicates the forward speed of the bottom wheel at the next moment;
[0091] When calculating the current speed ω of the bottom wheel, first determine the speed ω of the bottom wheel at the previous moment t-1 Whether it exceeds the predicted speed value. If it exceeds the predicted value, only the negative deviation is accumulated. If it does not exceed the predicted value, the positive deviation is accumulated.
[0092] The present invention uses gait parameters to establish a stride length and speed prediction model to predict the patient's stride length and speed at the next moment; at the same time, the bottom wheel is controlled by a PI control algorithm, and the exoskeleton mechanical leg 4 is controlled by an admittance control method. The gait phase is fully utilized to predict the human body's walking movement intention and it is organically combined with the exoskeleton mechanical leg 4 and the bottom wheel control, which can ensure the coordination and flexibility of the patient's human-computer interaction during walking training.
[0093] Example 2
[0094] A lower limb training robot, such as Figure 1 As shown, it includes a wheeled mobile platform 6 for executing robot movement and assisting patients in walking training. The wheeled mobile platform 6 includes two bottom wheels at the front and rear. The wheeled mobile platform 6 is connected to the pelvic mechanism 3 above the wheeled mobile platform 6 through a weight reduction system 2. The pelvic mechanism 3 is symmetrically provided with exoskeleton mechanical legs 4 on the left and right sides. The exoskeleton mechanical legs 4 have built-in exoskeleton motors. The exoskeleton mechanical legs 4 are connected to the pelvic mechanism 3 through support arms on the left and right sides.
[0095] The wheeled mobile platform 6 is connected to the weight reduction system 2 through the longitudinal support platforms on the left and right sides, the weight reduction system 2 is connected to the pelvic mechanism 3 through a ball screw, and the exoskeleton mechanical legs 4 are fixedly connected to the pelvic mechanism 3; a control cabinet 5 is provided on the wheeled mobile platform 6; the exoskeleton mechanical legs 4 provide power to assist the human body in walking, and can also apply a certain amount of leg lifting resistance when walking, which is used for the patient's lower limb muscle strength training; the weight reduction system 2 is used to control the movement of the body's center of gravity in the vertical plane, and the weight reduction system 2 transmits power to the pelvic mechanism 3 through a ball screw, provides support for the human body, and reduces the pressure on the soles of the human body.
[0096] The wheeled mobile platform 6 is mainly composed of bottom wheels, universal casters, drivers, electrical boards and other mechanisms; it is the basis for the autonomous movement of the lower limb training robot, and assists the patient in walking training; the exoskeleton mechanical leg 4 is connected to the pelvic mechanism 3 through the left and right support arms, and the exoskeleton mechanical leg 4 has a built-in drive motor, and the motor drives the leg connector; the exoskeleton mechanical leg 4 provides assistance to assist the patient in walking, and at the same time applies a certain leg lifting resistance when walking, which is used for the patient's lower limb muscle strength training; the weight loss system 2 is mainly composed of the upper computer flat panel 1, ball screw, weight loss system 2, drive motor and the like; the weight loss system 2 controls the movement of the body's center of gravity on the vertical plane, and the weight loss system 2 transmits power to the pelvic mechanism 3 through the ball screw, provides human body support, and reduces the patient's sole pressure. The entire lower limb training robot is based on the wheeled mobile platform 6, connected to the weight loss system 2 through the longitudinal support platforms on the left and right sides, and the weight loss system 2 is connected to the pelvic mechanism 3 through the ball screw, and the exoskeleton mechanical leg 4 is fixedly connected to the pelvic mechanism 3; the lower limb training robot also includes a sensor for collecting position, speed and angle information.
[0097] In summary, the present invention effectively overcomes the deficiencies in the prior art and has a high industrial utilization value. The above embodiments serve to illustrate the substantive content of the present invention, but do not limit the protection scope of the present invention. Those skilled in the art should understand that the technical solution of the present invention can be modified or replaced by equivalents without departing from the essence and protection scope of the technical solution of the present invention.
[0098] The above embodiments are specific implementation methods of the present invention, but the implementation methods of the present invention are not limited to the above embodiments. Any other combination, change, modification, substitution and simplification that does not exceed the design concept of the present invention shall fall within the protection scope of the present invention.
Claims
1. A wheel-leg coordination control method for a lower limb training robot based on gait phase, characterized in that: The following steps are involved: Step 1: Collect gait parameters of human walking, obtain gait change data of human walking through simulation analysis, build a step length and speed prediction model based on the stance phase and swing phase of the human gait cycle, and fit the change curves of joint angle, step length and speed during walking; the gait parameters include real-time position, speed and acceleration information of human walking; Step 2: Generate a change in the next step speed of the human body according to the step length and speed prediction model, and apply a certain leg-lifting resistance to the human body's legs according to the step length and speed prediction model; Step 3: According to the change in the next step speed of the human body generated in step 2, the PI control algorithm is used to control the movement of the bottom wheels of the lower limb training robot, so that the walking speed and gait of the lower limb training robot are consistent with those of the human body, thereby realizing coordinated control of the wheels and legs of the lower limb training robot and the human body.
2. The wheel-leg coordination control method for a lower limb training robot based on gait phase according to claim 1 is characterized in that: In step 1, the step of obtaining the joint angle change data is as follows: using the motion capture system on the lower limb training robot to collect the displacement coordinate change data of the human body during walking, performing inverse kinematics simulation on the collected coordinate data to obtain the joint angle change data; The change data of the joint angle is: The element calculation formula of the Jacobian matrix is: Among them, p i Represents the i-th coordinate component (x, y or z) of the lower limb walking mark point; q j represents the j joint angles; J ij Represents the effect of a small change in each joint angle on the change in the marker position.
3. The wheel-leg coordination control method for a lower limb training robot based on gait phase according to claim 2 is characterized in that: In step 1, the steps of fitting the joint angle change curve are: analyzing the change data of the joint angle in combination with the gait cycle to obtain the change curve of the joint angle, and fitting the change curve of the joint angle in the form of a sine function: Among them, A q is the amplitude, which is used to indicate the magnitude of change in the joint angle; T represents the length of the gait cycle; Indicates the phase offset, which is used to adjust the starting phase of the function; B indicates the vertical offset, which is used to adjust the baseline of the function; The change curve of joint angle is obtained by combining multiple sine functions: Where n is the number of sine functions, Represents the phase offset of n sine functions, B n Indicates the vertical offset of n sine functions.
4. The wheel-leg coordination control method for a lower limb training robot based on gait phase according to claim 1 is characterized in that: In step 1, the step length is calculated based on the maximum leg angle and leg length when the human body is walking, and the calculation formula of the step length is: Among them, L step Indicates step length; L l Indicates long legs; It indicates the angle at which the hip joint drives the front leg to swing; Indicates the angle at which the hip joint drives the hind leg to swing.
5. The wheel-leg coordination control method for a lower limb training robot based on gait phase according to claim 4 is characterized in that: In step 1, the step length varies periodically, and a step length variation curve is obtained by fitting a sinusoidal function: Among them, A is the amplitude of the step length, which indicates the range of change of the step length; T represents the gait cycle; represents the phase offset; k represents the coefficient that adjusts the influence of the maximum leg angle change on the step length; M represents the maximum leg angle change; M max Indicates the maximum possible change in the leg angle.
6. The wheel-leg coordination control method for a lower limb training robot based on gait phase according to claim 1 is characterized in that: In step 2, the pace is the change in the speed of the human body in the forward direction, and the steps of generating the pace using the step length and pace prediction model are as follows: V step (t i )=L step (t i )×f step (t i ); Among them, V step Indicates the pace, L step represents the step length, f step Indicates the cadence; By monitoring the changes in the stride length and frequency of the human body in different gait phases, the change in the speed of the human body's next step is generated. According to the change in the speed in the forward direction, the rotation speed and motion parameters of the robot's wheel legs are adjusted to match the walking speed and gait of the human body; ensuring that the robot can adapt to the walking speed of the human body and maintain coordination with the human body's gait.
7. The wheel-leg coordination control method for a lower limb training robot based on gait phase according to claim 6 is characterized in that: In step 2, the step frequency is calculated based on the support phase and swing phase of the human gait and the gait cycle determined by the sensors on the lower limb training robot; the support phase is the stage from heel landing to toe off the ground; the swing phase is the stage from toe off the ground to heel landing; According to the changing rules of the support phase and the swing phase in different gait phases, the exoskeleton mechanical legs of the lower limb training robot are used to apply a certain resistance to leg lifting during the swing phase when the human body lifts its legs, which is used for the patient's lower limb muscle strength training. The steps of applying resistance to leg lifting by the exoskeleton mechanical leg are: start - determine the time phase - whether to enter the swing phase - yes, the exoskeleton mechanical leg applies resistance - whether to enter the support phase - yes, the exoskeleton mechanical leg stops applying resistance - returns to continue determining the time phase.
8. The wheel-leg coordination control method for a lower limb training robot based on gait phase according to claim 1 is characterized in that: In step 3, the control method of the bottom wheel movement is: calculating the expected rotation speed of the bottom wheel according to the predicted change of the next step speed of the human body, and using the PI control algorithm to control the bottom wheel to rotate at the expected rotation speed; the calculation formula of the bottom wheel movement is: e dl (t)=ω e (t)-ω n (t); oh dl =ω n (t)+σ dl (t); Among them, e dl Indicates the error between the target speed and the actual speed of the bottom wheel; ω e represents the expected speed; ω n Indicates the current speed; σ dl Indicates the adjustment amount of the bottom wheel forward speed calculated according to PI control; K p Represents proportional gain; K i represents the integral gain; ω dl Indicates the forward speed of the bottom wheel at the next moment; When calculating the current speed ω of the bottom wheel, first determine the speed ω of the bottom wheel at the previous moment t-1 Whether it exceeds the predicted speed value. If it exceeds the predicted value, only the negative deviation is accumulated. If it does not exceed the predicted value, the positive deviation is accumulated.
9. A lower limb training robot using the lower limb training robot wheel-leg coordination control method based on gait phase according to any one of claims 1 to 8, characterized in that: The device comprises a wheeled mobile platform for executing robot movement and assisting patients in walking training, the wheeled mobile platform comprises two bottom wheels at the front and rear, the wheeled mobile platform is connected to a pelvic mechanism above the wheeled mobile platform through a weight reduction system, the pelvic mechanism is symmetrically provided with exoskeleton mechanical legs on the left and right sides, the exoskeleton mechanical legs have built-in exoskeleton motors, and the exoskeleton mechanical legs are connected to the pelvic mechanism through support arms on the left and right sides.
10. The lower limb training robot according to claim 9, characterized in that: The wheeled mobile platform is connected to the weight reduction system through the longitudinal support platforms on the left and right sides, the weight reduction system is connected to the pelvic mechanism through a ball screw, and the exoskeleton mechanical legs are fixedly connected to the pelvic mechanism; a control cabinet is provided on the wheeled mobile platform; the exoskeleton mechanical legs provide power to assist the human body in walking, and can also apply a certain amount of leg lifting resistance when walking, which is used for the patient's lower limb muscle strength training; the weight reduction system is used to control the movement of the body's center of gravity in the vertical plane, and the weight reduction system transmits power to the pelvic mechanism through a ball screw, provides support for the human body, and reduces the pressure on the soles of the human body.
Citation Information
Patent Citations
Exoskeleton type moving and walking rehabilitation training device and method
CN105456004A
Rehabilitation robot multimode control method on basis of multi-information fusion
CN108392795A
Control system and method for realizing synergy movement of lower limb robot and deweighting vehicle
CN110934715A
KMP-based lower limb exoskeleton rehabilitation robot and motion trajectory planning algorithm
CN112859868A
Robot lower limb training method
CN117064707A
