Lower limb rehabilitation exoskeleton robot control method and system, electronic equipment, medium

Through robust controllers based on U-K equations and multivariate information fusion technology, the gait trajectory of lower limb exoskeleton robots is corrected in real time, solving the problem of low control accuracy caused by gait trajectory error and human differences in the existing technology, achieving higher The training accuracy and adaptability reduce the pulling feeling.

CN118617388BActive Publication Date: 2024-11-15SUZHOU INST OF BIOMEDICAL ENG & TECH CHINESE ACADEMY OF SCI
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411087901.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-09
Publication Date
2024-11-15
Estimated Expiration
2044-08-09

AI Technical Summary

Technical Problem

During the training process, the existing lower limb rehabilitation exoskeleton robots have low control accuracy due to gait trajectory error and human differences, and cannot effectively adapt to the walking habits of different patients, resulting in a significant sense of pulling and it is difficult to ensure the stability and efficiency of training.

Method used

Using a robust controller based on U-K equation, combined with multivariate information fusion technology, through gait data fitting and interactive force signal processing, the gait trajectory of lower limb exoskeleton robot is corrected in real time, and a robust controller is established to handle system uncertainty. , introduces gait phase angle assisted torque control to improve trajectory tracking accuracy and flexibility.

Benefits of technology

It improves the control accuracy and stability of lower limb rehabilitation training, reduces the patient's sense of pulling, can better adapt to the gait needs of different groups of people, and enhances the flexibility and human-machine adaptability of the training process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118617388B_ABST
    Figure CN118617388B_ABST
Patent Text Reader

Abstract

The present invention provides a control method and system for a lower limb rehabilitation exoskeleton robot, an electronic device, and a medium, establishes a robust controller based on the U-K control theory, can generate additional control items to process the trajectory tracking error generated by the controlled system during operation, and improves the control accuracy. According to the robust control theory, additional control items are established to process the uncertainty factors of the controlled system, and the gait data fitting function is adjusted to meet the use requirements of different groups of people for the gait data trajectory. The trajectory compensation amount is generated through human-computer interaction force, and the expected trajectory is corrected in real time to reduce the pulling feeling of the patient during use. The expected trajectory is corrected through the real-time posture information of the patient's legs, so that the motor trajectory matches the patient's walking trajectory, and the flexibility of the training process is improved. The joint angle and angular velocity in the walking process are converted into a gait phase angle to generate an assist torque to compensate for the output torque of the controller to adapt to the walking habits of different patients.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of automation control technology, and in particular to a control method and system for a lower limb rehabilitation exoskeleton robot, electronic equipment, and a medium. Background Art

[0002] With the continuous aging of the domestic population, the incidence of stroke is also increasing year by year. Stroke refers to cerebrovascular circulation disorders caused by various reasons, and is also the main cause of lower limb motor dysfunction in patients. At present, rehabilitation methods assisted by physical therapists have problems such as the inability to guarantee training intensity, low efficiency, and uneven experience of physical therapists. The research on lower limb exoskeleton robots is an important research content in the field of rehabilitation.

[0003] During the rehabilitation training, the lower limb exoskeleton robot is required to drive the patient's lower limbs for rehabilitation training according to the gait trajectory. If the error between the running trajectory of the lower limb exoskeleton robot and the gait trajectory during training is large, it will seriously affect the effect of rehabilitation training; and due to the physical differences of patients, the load of the lower limb exoskeleton robot is different during rehabilitation training. Patients with certain motor abilities will also generate interaction forces with the lower limb exoskeleton robot during training, resulting in the patient feeling the obvious pulling sensation brought by the lower limb exoskeleton robot during lower limb rehabilitation training. And due to the different walking habits of users, a single gait tracking trajectory cannot adapt well to the needs of various groups of people. Therefore, while ensuring control accuracy and stability, lower limb training also needs to deal with the interaction force between the lower limb exoskeleton robot and the human body during exercise and the posture of the human body during walking, so that it can be better applied to actual rehabilitation training. Summary of the invention

[0004] In order to achieve the above-mentioned purpose and other advantages of the present invention, the first object of the present invention is to provide a lower limb rehabilitation exoskeleton robot control method, comprising the following steps:

[0005] Build a lower limb exoskeleton robot model;

[0006] By adjusting the gait data fitting function, the desired gait trajectory of the lower limb exoskeleton is obtained;

[0007] Using the lower limb exoskeleton gait desired trajectory as the controller's constraint trajectory;

[0008] Based on the lower limb exoskeleton robot model and in combination with the constraint trajectory, a robust controller based on the UK equation is established to achieve lower limb gait trajectory tracking control;

[0009] Acquire real-time interaction force signals between the lower limb exoskeleton robot and the lower limbs of the human body during training;

[0010] Converting the interaction force signal into a corresponding trajectory compensation amount;

[0011] Obtain the real-time motion trajectory of the patient while walking;

[0012] The desired gait trajectory of the lower limb exoskeleton is corrected in real time through the trajectory compensation amount and the motion trajectory.

[0013] Furthermore, the steps of building a lower limb exoskeleton robot model include:

[0014] Simplify the lower limb exoskeleton robot into a two-degree-of-freedom kinematic chain structure;

[0015] The position and posture of the lower limb exoskeleton robot are obtained based on the screw method;

[0016] Determine the velocity Jacobian matrix of the lower limb exoskeleton robot according to the coordinate homogeneous transformation matrix and the position and posture of the lower limb exoskeleton robot in the basic coordinate system;

[0017] According to the Lagrange equation, a dynamic model of a two-degree-of-freedom lower limb exoskeleton robot is established;

[0018] The dynamic equation of the lower limb exoskeleton robot system is obtained by sorting out the total kinetic energy and total potential energy of the lower limb exoskeleton robot.

[0019] Furthermore, obtaining the gait data fitting function includes:

[0020] Acquire the collected data of lower limb joint angles during human walking;

[0021] The lower limb joint angle data are fitted to obtain a gait data fitting function.

[0022] Furthermore, the gait data fitting function includes a hip joint gait data fitting function and a knee joint gait data fitting function.

[0023] Furthermore, the formula for obtaining the desired trajectory of the lower limb exoskeleton gait by adjusting the gait data fitting function is:

[0024] ;

[0025] in, is the joint angle change amplitude adjustment parameter, Adjust the parameters for the hip angle offset, Adjustment parameters for the knee angle offset, Adjust the parameters for the joint angle change cycle. is the hip joint gait data fitting function, is the knee joint gait data fitting function, To adjust the obtained hip joint gait data fitting function, The fitting function for the gait data obtained by adjusting the knee joint.

[0026] Furthermore, the steps of establishing a robust controller based on the UK equation based on the lower limb exoskeleton robot model and combining the constraint trajectory to achieve lower limb gait trajectory tracking control include:

[0027] Separating the determined parameters from the uncertain parameters in the dynamic equation of the lower limb exoskeleton robot system;

[0028] According to the UK dynamics theory, combined with the determined parameters and the second-order derivative of the constraint trajectory, the nominal torque that the controller should output is derived;

[0029] Generating an additional control term through the determined parameters and the first-order derivative of the constrained trajectory to process the trajectory tracking error generated by the controlled system during operation;

[0030] According to the robust control theory, additional control items are established for system uncertainty factors;

[0031] A robust controller based on UK control theory is established through the nominal torque, an additional control term for handling trajectory tracking errors, and an additional control term for system uncertainty factors.

[0032] Furthermore, the step of converting the interaction force signal into a corresponding trajectory compensation amount includes:

[0033] Performing Kalman filtering on the interaction force signal;

[0034] The processed interaction force signal is converted into the corresponding trajectory compensation through admittance control operation.

[0035] Furthermore, performing real-time correction on the desired trajectory of the lower limb exoskeleton gait through the motion trajectory includes:

[0036] The motion trajectory is subtracted from the lower limb exoskeleton gait expected trajectory, and the result is fed back to the lower limb exoskeleton gait expected trajectory, so as to achieve correction of the lower limb exoskeleton gait expected trajectory.

[0037] Furthermore, the method further comprises the following steps:

[0038] Obtain the real-time angular velocity of the patient during walking;

[0039] The motion trajectory and the angular velocity are converted into a gait phase angle using the formula:

[0040] ;

[0041] in, is the gait phase angle, is the angular velocity, is the joint angle;

[0042] The gait process is judged by the gait phase angle to output the assist torque;

[0043] The output torque of the controller is compensated by the assist torque.

[0044] Furthermore, the step of judging the gait process by the gait phase angle to output the assist torque includes:

[0045] The gait phase angle is normalized by the assist torque function to adjust the torque coefficient. The assist torque is:

[0046] ;

[0047] in, , They are torque coefficients, which are used to adjust the size and timing of the assist. To assist torque.

[0048] The second object of the present invention is to provide a lower limb rehabilitation exoskeleton robot control system, which uses the above method, including a host computer operation end, a lower computer control end, and an exoskeleton execution end, wherein the exoskeleton execution end includes a joint motor, a torque sensor, an IMU module, and an exoskeleton mechanism; wherein,

[0049] The upper computer operation end is used to adjust the gait data fitting function to obtain the desired gait trajectory of the lower limb exoskeleton, send control instructions to the lower computer control end, receive and process the data sent by the lower computer control end, and perform real-time correction on the desired gait trajectory of the lower limb exoskeleton through the interactive force signal and the patient's leg posture information;

[0050] The lower computer control end is used to calculate the torque that each joint motor of the lower limb exoskeleton should output at each moment and send it to the joint motor, and receive and process the current moment motion information sent by the joint motor, the patient's leg posture information sent by the IMU module, and the interactive force signal sent by the torque sensor, to obtain the trajectory compensation amount, the difference between the motion trajectory and the expected trajectory, and the power-assisting torque, and send the trajectory compensation amount and the difference between the motion trajectory and the expected trajectory to the upper computer operation end, calculate the torque of the next control cycle through the motion information, and compensate the output torque through the power-assisting torque;

[0051] The joint motor is used to enter the torque mode after receiving the output torque sent by the lower computer control end, and output the torque;

[0052] The absolute value encoder inside the joint motor is used to read the angle and angular velocity of the joint motor in real time, and feed the data back to the lower computer control end;

[0053] The torque sensor is used to detect the interaction force signal between the exoskeleton mechanism and the human body in real time, and send the interaction force signal to the lower computer control end in real time;

[0054] The IMU module is used to collect the patient's leg posture information in real time and send it to the lower computer control end in real time.

[0055] The third object of the present invention is to provide an electronic device, comprising: a memory on which a program code is stored; a processor, which is connected to the memory and implements the above method when the program code is executed by the processor.

[0056] A fourth object of the present invention is to provide a computer-readable storage medium having program instructions stored thereon, wherein the program instructions implement the above method when executed.

[0057] Compared with the prior art, the embodiments of the present invention have the following beneficial effects:

[0058] The present invention provides a control method and system for a lower limb rehabilitation exoskeleton robot based on Udwadia-Kalaba control theory and multivariate information fusion, establishes a robust controller based on UK control theory, can generate additional control items to deal with trajectory tracking errors generated by a controlled system during operation, and improves the control accuracy of the controller. Additional control items are established according to the robust control theory to deal with uncertainty factors of the controlled system. The robust controller based on UK control theory has consistent boundedness and ultimate boundedness, that is, the controlled system is stable and is less affected by position disturbances and uncertain factors.

[0059] In order to meet the different requirements of different groups of people for the use of gait data trajectories, the present invention adjusts the gait data fitting function, and uses the adjusted gait data fitting function as the constraint trajectory of the controller, which can better meet the needs of various groups of people.

[0060] The lower limb exoskeleton adopts a planar two-degree-of-freedom motion chain structure, and torque sensors are installed at the motion joints to collect human-computer interaction forces in real time during training. The trajectory compensation is generated through the admittance controller, and the expected trajectory is corrected in real time to reduce the patient's sense of pulling during use; an IMU module is tied to the patient's leg to collect the patient's leg posture information in real time, subtract it from the expected trajectory, and feed it back to the expected trajectory to achieve correction of the expected trajectory, so that the motor trajectory matches the patient's walking trajectory as much as possible, improving the flexibility of the training process. At the same time, the concept of gait phase angle is introduced, and the joint angle and angular velocity during walking are converted into gait phase angle. The phase angle assist controller generates an assist torque, which is fused with the torque generated by the UK robust controller to achieve torque compensation for gait direction and size for different gait phases to better adapt to the walking habits of different patients.

[0061] The above description is only an overview of the technical solution of the present invention. In order to more clearly understand the technical means of the present invention and implement it according to the contents of the specification, the following is a detailed description of the preferred embodiments of the present invention in conjunction with the accompanying drawings. The specific implementation of the present invention is given in detail by the following embodiments and their accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0062] The drawings described herein are used to provide a further understanding of the present invention and constitute a part of this application. The exemplary embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute an improper limitation of the present invention. In the drawings:

[0063] Figure 1 This is a schematic diagram of a lower limb rehabilitation exoskeleton robot control system in Example 1;

[0064] Figure 2 A lower limb rehabilitation exoskeleton robot control method process of embodiment 2 Figure 1 ;

[0065] Figure 3 A lower limb rehabilitation exoskeleton robot control method process of embodiment 2 Figure 2 ;

[0066] Figure 4 It is a schematic diagram of the structure of a two-degree-of-freedom kinematic chain;

[0067] Figure 5 A flow chart for building a lower limb exoskeleton robot model in Example 2;

[0068] Figure 6 is a flow chart for obtaining the gait data fitting function of Example 2;

[0069] Figure 7 Establish a flow chart for the robust controller based on UK equations of Example 2;

[0070] Figure 8 is a flow chart of interactive force conversion in Example 2;

[0071] Fig. 9 The flow chart of the assist torque generation of Example 2;

[0072] Fig.10 This is a schematic diagram of an electronic device according to Embodiment 3;

[0073] Fig.11 This is a schematic diagram of the storage medium of Example 4. DETAILED DESCRIPTION

[0074] The present invention is further described below in conjunction with the accompanying drawings and specific implementation methods. It should be noted that, under the premise of no conflict, the various embodiments or technical features described below can be arbitrarily combined to form a new embodiment.

[0075] In the following description, suffixes such as "component" or "unit" used to indicate elements are used only to facilitate the description of the present invention, and have no specific meanings by themselves. Therefore, "component" or "unit" may be used mixedly. Example 1

[0076] A lower limb rehabilitation exoskeleton robot control system, such as Figure 1 As shown, it includes an upper computer operation end, a lower computer control end, and an exoskeleton execution end, wherein the exoskeleton execution end includes a joint motor, a torque sensor, an IMU module, and an exoskeleton mechanism; wherein,

[0077] The upper computer operation end is used to adjust the gait data fitting function to obtain the desired gait trajectory of the lower limb exoskeleton, send control instructions to the lower computer control end, receive and process the data sent by the lower computer control end, and perform real-time correction on the desired gait trajectory of the lower limb exoskeleton through the interactive force signal and the patient's leg posture information;

[0078] In this embodiment, the upper computer communicates with the lower computer via a serial port interaction interface, and the communication baud rate can be up to 128000bps. It sends various control instructions to the lower computer, including exoskeleton posture calibration, start trajectory tracking control, stop motion, etc. At the same time, it can receive data sent by the lower computer and print the data after processing for subsequent analysis and processing.

[0079] The lower computer control end is used to calculate the torque that each joint motor of the lower limb exoskeleton should output at each moment and send it to the joint motor, and receive and process the current moment motion information sent by the joint motor, the patient's leg posture information sent by the IMU module, and the interactive force signal sent by the torque sensor, to obtain the trajectory compensation amount, the difference between the motion trajectory and the expected trajectory, and the power-assisting torque, and send the trajectory compensation amount and the difference between the motion trajectory and the expected trajectory to the upper computer operation end, calculate the torque of the next control cycle through the motion information, and compensate the output torque through the power-assisting torque;

[0080] In this embodiment, the lower computer control end includes an STM43H743 main control board and a TTL-to-485 chip. The main control board includes a variety of peripherals and can support multiple communication modes such as USART communication, CAN communication, and IIC communication. The communication baud rate of the TTL-to-485 chip can reach 4000000bps. The UASRT data is converted into RS485 data through the chip and information is exchanged with the joint motors of the exoskeleton execution end. The torque that should be output by each joint motor of the exoskeleton execution end at each moment is calculated through an internal program and sent to the joint motors. When the joint motors respond, they send the current motion information to the lower computer control end. The motion information will be input into the STM43H743 kernel control program in the form of feedback and participate in the calculation of the torque of the next control cycle.

[0081] The joint motor is used to enter the torque mode after receiving the output torque sent by the lower computer control end, and output the torque;

[0082] In this embodiment, the joint motor adopts Unitree motor, which can output corresponding torque according to control instructions, and the motor is integrated with absolute encoder and driver, which greatly reduces the volume and weight of the lower limb exoskeleton structure and is convenient for users to wear.

[0083] The exoskeleton connecting rod part of the exoskeleton mechanism adopts an aluminum structure, which has good strength and rigidity and can bear a large load. The overall weight of the exoskeleton structure is small, making it easy to wear.

[0084] The absolute value encoder inside the joint motor is used to read the angle and angular velocity of the joint motor in real time, and feed the data back to the lower computer control end;

[0085] The torque sensor is used to detect the interaction force signal between the exoskeleton mechanism and the human body in real time, and send the interaction force signal to the lower computer control end in real time; specifically, the torque sensor sends the torque signal to the lower computer control end in real time through RS485 communication.

[0086] The IMU module is used to collect the patient's leg posture information in real time and send it to the lower computer control end in real time.

[0087] In this embodiment, the IMU module is tied to the patient's leg through a strap to collect the patient's leg posture in real time. The multivariate signal is processed by Kalman filtering and sent to the lower computer control end.

[0088] This system realizes the trajectory tracking control of the lower limb exoskeleton robot based on the robust control algorithm of UK control theory. The control system ensures the control accuracy and stability of the control system through the robust control algorithm of UK control theory. The torque sensor detects the human-computer interaction force during the training process and generates the corresponding angle compensation. The IMU module detects the motion state and gait phase of each joint of the human body in real time, processes the multivariate information and corrects the control trajectory in real time to improve the flexibility and human-computer adaptability of the rehabilitation training process.

[0089] For a detailed description of the control method of the lower limb rehabilitation exoskeleton robot control system, please refer to the corresponding description in the following method embodiment, which will not be repeated here.

[0090] The present invention provides a lower limb rehabilitation exoskeleton robot control system based on Udwadia-Kalaba control theory and multi-information fusion. Compared with the traditional lower limb exoskeleton robot control system, the robot control system can correct the expected trajectory according to the adjustment assist torque and tracking trajectory of multi-information feedback to reduce the patient's pulling sensation during use, and can better meet the needs of lower limb rehabilitation training.

[0091] The lower limb rehabilitation exoskeleton robot control system includes a host computer operation end, a lower computer control end and an exoskeleton execution end. Each part cooperates with each other to realize lower limb exoskeleton rehabilitation training based on multi-information collection and processing.

[0092] The host computer operation terminal can adjust the gait trajectory of lower limb rehabilitation training through the serial communication interface and the host computer software to meet the needs of different patients, and can detect the patient's movement status during rehabilitation training in real time, so as to make targeted adjustments to the rehabilitation training according to the feedback information.

[0093] The lower computer control end uses the STM32H743 main control board, which includes rich communication methods and peripherals such as USART, RS485, CAN, and the communication baud rate of RS485 can reach 4Mbps, which can realize fast communication with the lower limb exoskeleton joint motors, and realize fast sending of control information and fast receiving of feedback information, which greatly shortens the control cycle and improves the control accuracy.

[0094] The upper computer operation end and the lower computer control end use two different communication methods, USART and RS485 respectively. The two use different communication channels, which do not interfere with each other while also achieving rapid information exchange.

[0095] The lower limb exoskeleton adopts a planar two-degree-of-freedom motion chain structure, and torque sensors are installed at the motion joints to collect human-computer interaction forces in real time during training, generate trajectory compensation through the admittance controller, and make real-time corrections to the ideal trajectory. An IMU module is strapped to the patient's leg to collect the patient's leg posture information in real time, generate assist torque through the phase angle assist controller, and integrate it with the torque generated by the UK controller to better adapt to the walking habits of different patients.

[0096] The joint motor uses Unitree motor, which can output corresponding torque according to the control command, and the motor is integrated with absolute encoder and driver, which greatly reduces the volume and weight of the lower limb exoskeleton structure and is convenient for users to wear. At the same time, the absolute encoder inside the motor can read the motor angle and angular velocity in real time, and promptly feedback the motion information to the control end, ensuring the smooth control process. Example 2

[0097] A method for controlling a lower limb rehabilitation exoskeleton robot is implemented by the above-mentioned lower limb rehabilitation exoskeleton robot control system. For a detailed description of the lower limb rehabilitation exoskeleton robot control system, please refer to the corresponding description in the above-mentioned embodiment of the lower limb rehabilitation exoskeleton robot control system, which will not be repeated here. Figure 2 , Figure 3 As shown, the method comprises the following steps:

[0098] S1. Build a lower limb exoskeleton robot model;

[0099] like Figure 4 , Figure 5 As shown, the steps of building a lower limb exoskeleton robot model include:

[0100] S11. Simplify the lower limb exoskeleton robot as follows Figure 4 The two-degree-of-freedom kinematic chain structure shown;

[0101] Figure 4 In the figure, the length of the rod at the thigh position of the lower limb exoskeleton robot is , quality is , the length of the rod at the calf position is , the quality is , the mass at the knee joint is , the load mass at the end of the calf is , the angle between the thigh position bar and the vertical direction is , the rotation angle of the calf position bar relative to the thigh position bar is , the angular velocity of the hip joint is , the angular velocity of the knee joint is , the angular acceleration of the hip joint is , the angular acceleration of the knee joint is .

[0102] S12. Based on the screw method, the position and posture of the lower limb exoskeleton robot are:

[0103] ;

[0104] S13, determining the velocity Jacobian matrix of the lower limb exoskeleton robot according to the coordinate homogeneous transformation matrix and the position and posture of the lower limb exoskeleton robot in the basic coordinate system. The Jacobian matrix in the basic coordinate system is:

[0105] ;

[0106] S14. According to the Lagrange equation, a two-degree-of-freedom lower limb exoskeleton robot dynamics model is established to perform gait trajectory tracking control. According to the Lagrange equation, the lower limb exoskeleton robot system dynamics model is defined as:

[0107] ,

[0108] ,

[0109] in, is the Lagrangian function, which means the total kinetic energy of the system minus the total potential energy, that is, the energy difference between the two. and They represent the kinetic energy and potential energy of the lower limb exoskeleton robot system, is the joint torque of the two joints of the exoskeleton robot, represents the angular velocity of the two joints, Indicates the angles of the two joints of the exoskeleton robot;

[0110] Total kinetic energy of lower limb exoskeleton robot for:

[0111] ;

[0112] Total kinetic energy of lower limb exoskeleton robot for:

[0113] ;

[0114] S15. The dynamic equation of the lower limb exoskeleton robot system is obtained by sorting out the total kinetic energy and total potential energy of the lower limb exoskeleton robot as follows:

[0115] ;

[0116] in, is the mass matrix of the system, is the system Coriolis force / centrifugal force matrix, is the gravity matrix, is the joint angle, is the joint angular velocity, is the joint angular acceleration.

[0117] Where: ;

[0118] .

[0119] S2, obtaining the expected gait trajectory of the lower limb exoskeleton by adjusting the gait data fitting function;

[0120] like Figure 6 As shown, the acquisition of the gait data fitting function includes:

[0121] S21, acquiring the collected data of the angles of the lower limb joints of the human body during walking;

[0122] S22. Fitting the lower limb joint angle data to obtain a gait data fitting function.

[0123] In this embodiment, the expected trajectory of the lower limb gait trajectory tracking control is the change in the joint angles of the hip joint and the knee joint during walking. A three-dimensional motion capture device is used to collect the joint angle data of the human body during walking, and MATLAB is used to fit the data to obtain the gait data fitting function as the expected joint trajectory of the lower limb exoskeleton robot control process.

[0124] Because the gait trajectory is periodic and the phase difference between the motion trajectories of the joints of both legs during walking is about half a cycle, it is only necessary to fit the unilateral gait data of the lower limbs, and the control system only needs to use the unilateral gait data curve as the expected trajectory for control.

[0125] Specifically, the gait data fitting function includes a hip joint gait data fitting function and a knee joint gait data fitting function.

[0126] Hip joint gait data fitting function:

[0127] ;

[0128] Knee joint gait data fitting function:

[0129] ;

[0130] In order to meet the different requirements of different groups of people for the use of gait data trajectories, the gait data fitting function can be adjusted, and specifically, the gait data fitting function needs to be parameterized.

[0131] Specifically, the formula for obtaining the expected trajectory of the lower limb exoskeleton gait by adjusting the gait data fitting function is:

[0132] ;

[0133] in, is the joint angle change amplitude adjustment parameter, Adjust the parameters for the hip angle offset, Adjustment parameters for the knee angle offset, Adjust the parameters for the joint angle change cycle. is the hip joint gait data fitting function, is the knee joint gait data fitting function, To adjust the obtained hip joint gait data fitting function, The fitting function for the gait data obtained by adjusting the knee joint.

[0134] S3, using the lower limb exoskeleton gait expected trajectory as the controller's constraint trajectory;

[0135] S4. Based on the lower limb exoskeleton robot model and in combination with the constraint trajectory, a robust controller based on the UK equation is established. By setting the boundary of the uncertainty factor, additional control items are added to the controller to reduce the impact of the system uncertainty factors, so as to achieve high-precision lower limb gait trajectory tracking control;

[0136] like Figure 7 As shown, the steps of establishing a robust controller based on the UK equation based on the lower limb exoskeleton robot model and the constraint trajectory to achieve lower limb gait trajectory tracking control include:

[0137] S41, separating the determined parameters and the uncertain parameters in the dynamic equation of the lower limb exoskeleton robot system:

[0138] ;

[0139] The nominal part of the control system is , which is used to construct the nominal system, and the uncertain part is , which is used to construct the uncertain system. For the subsequent control system expression, the following parameters are expressed as:

[0140] ;

[0141] S42. According to the UK dynamics theory, combined with the determined parameters and the second-order derivative of the constraint trajectory, the nominal torque expression that the controller should output is derived as follows:

[0142] ;

[0143] S43, generating an additional control term by using the determined parameters and the first-order derivative of the constraint trajectory, that is, adding Used to generate additional control items to deal with the trajectory tracking error generated by the controlled system during operation and improve the control accuracy of the controller;

[0144] ;

[0145] , Both control items use the nominal parameters of the system as control parameters. is a scalar, for design parameters.

[0146] S44. According to the robust control theory, additional control items for system uncertainty factors are established. For the matrix containing uncertainty factors in the above formula , there exists a function , so that all All satisfy the following inequalities:

[0147] ;

[0148] Represents the minimum eigenvalue of the matrix, and the system has no uncertain factors, that is, when When it is always equal to 0, For any ,have Full rank, and and They are inverse matrices of each other, for the control items Design parameters , ,at the same time , define the matrix ,make

[0149] ;

[0150] To ensure the function The minimum value is greater than or equal to 0 to limit the lower limit of the controlled system. At the same time, to limit the boundary of the uncertainty factors of the controlled system, the design function ,satisfy:

[0151] ;

[0152] In the formula, It represents the difference between the gravity matrix and the nominal gravity matrix, which is the uncertain parameter part of the gravity matrix.

[0153] Based on the above analysis and conditions, control items are established to deal with uncertain factors of the controlled system. :

[0154] ;

[0155] ;

[0156] in, It is used to adjust the sensitivity of the control item to the output control torque of the system uncertainty factors. is the design parameter of the system. Adjustment to achieve control items The purpose is to make adjustments based on different boundaries of uncertainty factors.

[0157] When the above conditions are met, the robust controller based on UK control theory has uniform boundedness and ultimate boundedness, that is, the controlled system is stable and is less affected by position disturbances and uncertainties.

[0158] S45, establishing a robust controller based on UK control theory through the nominal torque, the additional control item for processing the trajectory tracking error, and the additional control item for the system uncertainty factor:

[0159] .

[0160] In order to reduce the pulling sensation caused by the mismatch between the exoskeleton's motion trajectory and the human body's gait during rehabilitation training, this embodiment uses a torque sensor to measure the interaction force between the exoskeleton and the human body during training. , S5, obtaining real-time interaction force signals between the lower limb exoskeleton robot and the lower limbs of the human body during training;

[0161] S6, converting the interaction force signal into a corresponding trajectory compensation amount;

[0162] like Figure 8 As shown, the step of converting the interaction force signal into a corresponding trajectory compensation amount includes:

[0163] S61, performing Kalman filtering on the interaction force signal to eliminate jitter and improve the compliance of the control process;

[0164] S62, converting the processed interaction force signal into a corresponding trajectory compensation amount through admittance control calculation.

[0165] In this embodiment, the admittance impedance model is shown as follows:

[0166] ;

[0167] By performing Laplace transform on the above formula, the transfer function of the admittance model can be obtained as follows:

[0168] ;

[0169] Assume that the expected gait curve of the lower limb exoskeleton is During the lower limb rehabilitation training, the torque sensor reads the human-computer interaction force in real time. The interaction force is converted into the corresponding trajectory compensation after the admittance calculation of the lower computer control end , trajectory compensation In order to minimize the human-computer interaction force, it is necessary to make a corresponding compensation amount for the expected trajectory of gait.

[0170] In this embodiment, an IMU module is added to the patient's legs in the form of a strap to achieve real-time detection of the patient's motion information during walking. Since the patient's legs are connected to the exoskeleton robot with a flexible strap, the patient's motion trajectory does not completely overlap with the joint motor trajectory, resulting in a mismatch in the motion trajectory, which affects the training effect. In order to improve the flexibility of the training process and make the motor trajectory match the patient's walking trajectory as much as possible, an IMU module is used to read the patient's motion trajectory in real time during exercise. ,S7, obtaining the real-time motion trajectory of the patient during walking;

[0171] S8. Correct the desired gait trajectory of the lower limb exoskeleton in real time using the trajectory compensation amount and the motion trajectory.

[0172] Specifically, performing real-time correction on the desired trajectory of the lower limb exoskeleton gait through the motion trajectory includes:

[0173] Acquire real-time motion trajectory of patients during movement Afterwards, the motion trajectory is subtracted from the lower limb exoskeleton gait expected trajectory, and the result is fed back to the lower limb exoskeleton gait expected trajectory, so as to achieve the correction of the lower limb exoskeleton gait expected trajectory.

[0174] At the same time, the concept of gait phase angle is introduced to convert the joint angle during walking With angular velocity Converted into gait phase angle, the gait process is judged by the gait phase angle, and the corresponding torque is output Output torque to controller Specifically, if Fig. 9 As shown, the following steps are also included:

[0175] S91, obtaining the real-time angular velocity of the patient during walking;

[0176] S92, converting the motion trajectory and the angular velocity into a gait phase angle, using the formula:

[0177] ;

[0178] in, is the gait phase angle, is the angular velocity, is the joint angle;

[0179] S93, judging the gait process by the gait phase angle to output the assist torque; since there is a relatively linear relationship between the gait phase angle and the gait phase, the gait phase angle is used to identify the state of the patient's legs during walking, such as the support phase and the swing phase, and the gait phase angle is normalized by the assist torque function to adjust the torque coefficient. The assist torque is as follows:

[0180] ;

[0181] in , They are torque coefficients, which are used to adjust the size and timing of assistance.

[0182] S94, compensating the output torque of the controller by the power-assist torque. That is, by establishing a phase angle power-assist controller, torque compensation of gait direction and magnitude can be achieved for different gait phases.

[0183] This embodiment provides a lower limb rehabilitation exoskeleton robot control method based on Udwadia-Kalaba control theory and multi-information fusion, establishes a robust controller based on UK control theory, and is capable of generating additional control items to handle trajectory tracking errors generated by the controlled system during operation, thereby improving the control accuracy of the controller. Additional control items are established based on the robust control theory to handle the uncertainty factors of the controlled system. The robust controller based on UK control theory has consistent boundedness and ultimate boundedness, that is, the controlled system is stable and is less affected by position disturbances and uncertain factors.

[0184] In order to meet the different requirements of different groups of people for the use of gait data trajectories, the present invention adjusts the gait data fitting function, and uses the adjusted gait data fitting function as the constraint trajectory of the controller, which can better meet the needs of various groups of people.

[0185] The lower limb exoskeleton adopts a planar two-degree-of-freedom motion chain structure, and torque sensors are installed at the motion joints to collect human-computer interaction forces in real time during training. The trajectory compensation is generated through the admittance controller, and the expected trajectory is corrected in real time to reduce the patient's sense of pulling during use; an IMU module is tied to the patient's leg to collect the patient's leg posture information in real time, subtract it from the expected trajectory, and feed it back to the expected trajectory to achieve correction of the expected trajectory, so that the motor trajectory matches the patient's walking trajectory as much as possible, improving the flexibility of the training process. At the same time, the concept of gait phase angle is introduced, and the joint angle and angular velocity during walking are converted into gait phase angle. The phase angle assist controller generates an assist torque, which is fused with the torque generated by the UK robust controller to achieve torque compensation for gait direction and size for different gait phases to better adapt to the walking habits of different patients. Example 3

[0186] An electronic device, such as Fig.10 As shown, it includes: a memory on which program codes are stored; a processor connected to the memory, and when the program codes are executed by the processor, a method for controlling a lower limb rehabilitation exoskeleton robot is implemented. For a detailed description of the method, reference may be made to the corresponding description in the above method embodiment, which will not be repeated here. Example 4

[0187] A computer readable storage medium such as Fig.11 As shown, program instructions are stored thereon, and when the program instructions are executed, a method for controlling a lower limb rehabilitation exoskeleton robot is implemented. For a detailed description of the method, reference may be made to the corresponding description in the above method embodiment, and no further description is given here.

[0188] The number of devices and processing scales described here are used to simplify the description of the present invention. Applications, modifications and variations of the present invention will be obvious to those skilled in the art.

[0189] Although the embodiments of the present invention have been disclosed as above, they are not limited to the applications listed in the specification and the implementation modes, and they can be fully applied to various fields suitable for the present invention. For those familiar with the art, additional modifications can be easily implemented. Therefore, without departing from the general concept defined by the claims and the scope of equivalents, the present invention is not limited to the specific details and the illustrations shown and described herein.

[0190] The apparatus, electronic device, non-volatile computer storage medium and method provided in the embodiments of this specification correspond to each other, and therefore, the apparatus, electronic device and non-volatile computer storage medium also have similar beneficial technical effects as the corresponding method. Since the beneficial technical effects of the method have been described in detail above, the beneficial technical effects of the corresponding apparatus, electronic device and non-volatile computer storage medium will not be repeated here.

[0191] Those skilled in the art also know that, in addition to implementing the controller in a purely computer-readable program code, the controller can be made to implement the same function in the form of logic gates, switches, application-specific integrated circuits, programmable logic controllers, and embedded microcontrollers by logically programming the method steps. Therefore, such a controller can be considered as a hardware component, and the devices for implementing various functions included therein can also be considered as structures within the hardware component. Or even, the devices for implementing various functions can be considered as both software units for implementing the method and structures within the hardware component.

[0192] The systems, devices or units described in the above embodiments can be implemented by computer chips or entities, or by products with certain functions. For the convenience of description, the above devices are described separately by functions in various units. Of course, when implementing one or more embodiments of this specification, the functions of each unit can be implemented in the same or more software and / or hardware.

[0193] Those skilled in the art will appreciate that the embodiments of this specification may be provided as methods, systems, or computer program products. Therefore, the embodiments of this specification may take the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Moreover, the embodiments of this specification may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program codes.

[0194] This specification is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of this specification. It should be understood that each process and / or block in the flowchart and / or block diagram, as well as the combination of processes and / or blocks in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to produce a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0195] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture including an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0196] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0197] It should also be noted that the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, commodity or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, commodity or device. In the absence of more restrictions, the elements defined by the sentence "comprises a ..." do not exclude the existence of other identical elements in the process, method, commodity or device including the elements.

[0198] The specification may be described in the general context of computer-executable instructions executed by a computer, such as program units. Generally, program units include routines, programs, objects, components, data structures, etc. that perform specific tasks or implement specific abstract data types. The specification may also be practiced in distributed computing environments where tasks are performed by remote processing devices connected via a communications network. In a distributed computing environment, program units may be located in local and remote computer storage media, including storage devices.

[0199] Each embodiment in this specification is described in a progressive manner, and the same or similar parts between the embodiments can be referred to each other, and each embodiment focuses on the differences from other embodiments. In particular, for the system embodiment, since it is basically similar to the method embodiment, the description is relatively simple, and the relevant parts can be referred to the partial description of the method embodiment.

[0200] The above description is only an embodiment of this specification and is not intended to limit one or more embodiments of this specification. For those skilled in the art, one or more embodiments of this specification may have various changes and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of one or more embodiments of this specification shall be included in the scope of the claims of one or more embodiments of this specification.

Claims

1. A control method for a lower limb rehabilitation exoskeleton robot, characterized in that: The following steps are involved: Build a lower limb exoskeleton robot model; By adjusting the gait data fitting function, the desired gait trajectory of the lower limb exoskeleton is obtained; Using the lower limb exoskeleton gait desired trajectory as the controller's constraint trajectory; Based on the lower limb exoskeleton robot model and in combination with the constraint trajectory, a robust controller based on the UK equation is established to achieve lower limb gait trajectory tracking control; Obtain the real-time interactive force signal between the lower limb rehabilitation exoskeleton robot and the human lower limbs during training; Converting the interaction force signal into a corresponding trajectory compensation amount; Obtain the real-time motion trajectory of the patient while walking; Correcting the desired gait trajectory of the lower limb exoskeleton in real time by using the trajectory compensation amount and the motion trajectory; The following steps are also included: Obtain the real-time angular velocity of the patient during walking; The motion trajectory and the angular velocity are converted into a gait phase angle using the formula: ; in, is the gait phase angle, is the angular velocity, is the joint angle; The gait process is judged by the gait phase angle to output the assist torque; Compensating the output torque of the controller by means of the assist torque; The step of judging the gait process by the gait phase angle to output the assist torque comprises: The gait phase angle is normalized by the assist torque function to adjust the torque coefficient. The assist torque is: ; in, , They are torque coefficients, which are used to adjust the size and timing of the assist. To assist the torque; The steps of building a lower limb exoskeleton robot model include: The lower limb rehabilitation exoskeleton robot is simplified into a two-degree-of-freedom kinematic chain structure; The position and posture of the lower limb rehabilitation exoskeleton robot are obtained based on the screw method; Determine the velocity Jacobian matrix of the lower limb rehabilitation exoskeleton robot according to the coordinate homogeneous transformation matrix and the position and posture of the lower limb rehabilitation exoskeleton robot in the basic coordinate system; According to the Lagrange equation, a dynamic model of a two-degree-of-freedom lower limb exoskeleton robot is established; The dynamic equation of the lower limb exoskeleton robot system is obtained by sorting out the total kinetic energy and total potential energy of the lower limb rehabilitation exoskeleton robot. The acquisition of the gait data fitting function includes: Acquire the collected data of lower limb joint angles during human walking; Fitting the lower limb joint angle data to obtain a gait data fitting function; The gait data fitting function includes a hip joint gait data fitting function and a knee joint gait data fitting function; The formula for obtaining the expected trajectory of the lower limb exoskeleton gait by adjusting the gait data fitting function is: ; ; in, is the joint angle change amplitude adjustment parameter, Adjust the parameters for the hip angle offset, Adjustment parameters for the knee angle offset, Adjust the parameters for the joint angle change cycle. is the hip joint gait data fitting function, is the knee joint gait data fitting function, To adjust the obtained hip joint gait data fitting function, To adjust the fitting function of the knee gait data; The steps of establishing a robust controller based on the UK equation based on the lower limb exoskeleton robot model and combining the constraint trajectory to achieve lower limb gait trajectory tracking control include: Separating the determined parameters from the uncertain parameters in the dynamic equation of the lower limb exoskeleton robot system; According to the UK dynamics theory, combined with the determined parameters and the second-order derivative of the constraint trajectory, the nominal torque that the controller should output is derived; Generating additional control items through the determined parameters and the first-order derivatives of the constrained trajectory to process the trajectory tracking error generated by the lower limb exoskeleton robot system during operation; According to the robust control theory, additional control items are established for system uncertainty factors; A robust controller based on UK control theory is established through the nominal torque, the additional control term generated by the first-order derivative and the additional control term for the system uncertainty factor.

2. A lower limb rehabilitation exoskeleton robot control method as claimed in claim 1, characterized in that: The step of converting the interaction force signal into a corresponding trajectory compensation amount comprises: Performing Kalman filtering on the interaction force signal; The processed interaction force signal is converted into the corresponding trajectory compensation through admittance control operation.

3. A lower limb rehabilitation exoskeleton robot control method as claimed in claim 1, characterized in that: The real-time correction of the desired gait trajectory of the lower limb exoskeleton by the motion trajectory includes: The motion trajectory is subtracted from the lower limb exoskeleton gait expected trajectory, and the result is fed back to the lower limb exoskeleton gait expected trajectory, so as to achieve correction of the lower limb exoskeleton gait expected trajectory.

4. A lower limb rehabilitation exoskeleton robot control system, using the method according to any one of claims 1 to 3, characterized in that: It includes an upper computer operation terminal, a lower computer control terminal, and an exoskeleton execution terminal, wherein the exoskeleton execution terminal includes a joint motor, a torque sensor, an IMU module, and an exoskeleton mechanism; wherein, The upper computer operation end is used to adjust the gait data fitting function to obtain the desired gait trajectory of the lower limb exoskeleton, send control instructions to the lower computer control end, receive and process the data sent by the lower computer control end, and perform real-time correction on the desired gait trajectory of the lower limb exoskeleton through the interactive force signal and the patient's leg posture information; The lower computer control end is used to calculate the torque that each joint motor of the lower limb exoskeleton should output at each moment and send it to the joint motor, and receive and process the current moment motion information sent by the joint motor, the patient's leg posture information sent by the IMU module, and the interactive force signal sent by the torque sensor, to obtain the trajectory compensation amount, the difference between the motion trajectory and the expected trajectory, and the power-assisting torque, and send the trajectory compensation amount and the difference between the motion trajectory and the expected trajectory to the upper computer operation end, calculate the torque of the next control cycle through the motion information, and compensate the output torque through the power-assisting torque; The joint motor is used to enter the torque mode after receiving the output torque sent by the lower computer control end, and output the torque; The absolute value encoder inside the joint motor is used to read the angle and angular velocity of the joint motor in real time, and feed the data back to the lower computer control end; The torque sensor is used to detect the interaction force signal between the exoskeleton mechanism and the human body in real time, and send the interaction force signal to the lower computer control end in real time.

5. An electronic device, characterized in that: include: A memory having program code stored therein; A processor is connected to the memory, and when the program code is executed by the processor, the method according to any one of claims 1 to 3 is implemented.

6. A computer-readable storage medium, characterized in that: Program instructions are stored thereon, and when the program instructions are executed, the method according to any one of claims 1 to 3 is implemented.