Exoskeleton robot control method and device, exoskeleton robot and storage medium
By receiving user data, calculating the length of the exoskeleton robot's thigh configuration and using a screw motor to telescope, the problem that traditional exoskeleton robots cannot be adjusted is solved, and wear comfort and control accuracy are improved.
Patent Information
- Application Number
- CN202411176756.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-26
- Publication Date
- 2024-12-06
AI Technical Summary
Traditional exoskeleton robots cannot adjust according to the user's actual leg length, resulting in discomfort in wear and low efficiency in rehabilitation training.
By receiving the user's physiological data, determine the thigh coefficient, calf coefficient and height coefficient, calculate and adjust the thigh and calf configuration length of the exoskeleton robot, and use a screw motor to telescope to adapt to the leg length of different users.
It improves the adaptability of the exoskeleton robot and the user, enhances the comfort and stability of wear, realizes accurate adjustment of the length of the legs, and improves the overall control accuracy.
Smart Images

Figure CN119074475A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of robot control, and in particular to an exoskeleton robot control method, device, exoskeleton robot and storage medium. Background Art
[0002] At present, with the development of robotics and rehabilitation engineering, exoskeleton robots are mainly used for medical care. Among many rehabilitation exoskeletons, lower limb exoskeletons can provide important medical and rehabilitation support.
[0003] When users need to use an exoskeleton robot for rehabilitation training, they need to queue up in the hospital and use the same exoskeleton robot. Traditional exoskeleton robots are often based on preset movement modes or fixed parameters and cannot be adjusted according to the user's actual leg length. Summary of the invention
[0004] In order to overcome the deficiencies of the prior art, the present invention provides an exoskeleton robot control method, device, exoskeleton robot and storage medium, which automatically adapt to the different leg lengths of different users to improve the comfort of wearing the exoskeleton robot.
[0005] A first aspect of the present application provides an exoskeleton robot control method, the method comprising: When receiving the physiological data of the target user, determining the thigh coefficient, calf coefficient and height coefficient of the exoskeleton robot; Determine the thigh configuration length of the exoskeleton robot according to the physiological data, the thigh coefficient and the height coefficient, and determine the calf configuration length of the exoskeleton robot according to the physiological data, the calf coefficient and the height coefficient; The thigh of the exoskeleton robot is controlled to be extended and retracted according to the thigh configuration length, and the calf of the exoskeleton robot is controlled to be extended and retracted according to the retractable calf configuration length.
[0006] In an optional embodiment, the determining of the thigh configuration length of the exoskeleton robot according to the physiological data, the thigh coefficient and the height coefficient comprises: The thigh configuration length is determined by the following formula: ; in, configuring a length for said thigh, is the body coefficient, is the thigh coefficient, H is the height coefficient; The body coefficient is determined by the following formula: ; Among them, h is the height parameter table in the physiological data, W is the weight parameter in the physiological data, and BMI is the BMI parameter in the physiological data.
[0007] In an optional embodiment, determining the calf configuration length of the exoskeleton robot according to the physiological data, the calf coefficient and the height coefficient includes: The calf configuration length is determined by the following formula: ; in, configuring a length for said thigh, is the calf coefficient.
[0008] In an optional embodiment, controlling the thigh of the exoskeleton robot to extend and retract according to the configured length of the thigh includes: Obtaining motor control parameters and lead screw moving distance of the lead screw motor of the exoskeleton robot at the current moment; Determining a motor control voltage of the lead screw motor according to the motor control parameter and the lead screw moving distance; The lead screw motor is controlled to extend and retract according to the motor control voltage, so that the thigh of the exoskeleton robot is extended and retracted.
[0009] In an optional implementation, controlling the lead screw motor to extend and retract according to the motor control voltage includes: When it is determined that the motor control voltage is greater than 0, controlling the lead screw motor to extend; When it is determined that the motor control voltage is less than 0, controlling the lead screw motor to retract; When it is determined that the motor control voltage is equal to 0, the operation of extending and retracting the lead screw motor is not performed.
[0010] In an optional embodiment, the method further comprises: When receiving the left thigh control signal, the left calf control signal, the right thigh control signal and the right calf control signal of the exoskeleton robot, determining the left thigh control voltage corresponding to the left thigh control signal, the left calf control voltage corresponding to the left calf control signal, the right thigh control voltage corresponding to the right thigh control signal and the right calf control voltage corresponding to the right calf control signal; Determine the left and right thigh control errors of the exoskeleton robot according to the left thigh control voltage and the right thigh control voltage, and determine the left and right calf control errors of the exoskeleton robot according to the left calf control voltage and the right calf control voltage; The left and right legs of the exoskeleton robot are controlled to extend and retract according to the left and right thigh control errors and the left and right calf control errors.
[0011] In an optional embodiment, controlling the left and right legs of the exoskeleton robot to extend and retract according to the left and right thigh control errors and the left and right calf control errors includes: When the left and right thigh control error is greater than 0, adjusting the first control proportional parameter of the left thigh lead screw motor of the exoskeleton robot so that the left thigh control voltage is reduced until the left and right thigh control error is equal to 0; When the left and right thigh control error is less than 0, adjusting the second control proportional parameter of the right thigh lead screw motor of the exoskeleton robot so that the right thigh control voltage is reduced until the left and right thigh control error is equal to 0; When the left and right calf control error is greater than 0, adjusting the third control ratio parameter of the left calf lead screw motor of the exoskeleton robot so that the left calf control voltage decreases until the left and right calf control error is equal to 0; When the left and right calf control error is less than 0, the fourth control proportional parameter of the right calf lead screw motor of the exoskeleton robot is adjusted to reduce the right calf control voltage until the left and right calf control error is equal to 0.
[0012] A second aspect of the present application provides an exoskeleton robot control device, the device comprising: The first determination module is used to determine the thigh coefficient, calf coefficient and height coefficient of the exoskeleton robot when receiving the physiological data of the target user; a second determination module, configured to determine a thigh configuration length of the exoskeleton robot according to the physiological data, the thigh coefficient and the height coefficient, and to determine a calf configuration length of the exoskeleton robot according to the physiological data, the calf coefficient and the height coefficient; The control module is used to control the extension and retraction of the thigh of the exoskeleton robot according to the configuration length of the thigh, and to control the extension and retraction of the calf of the telescopic exoskeleton robot according to the configuration length of the telescopic calf.
[0013] A third aspect of the present application provides an exoskeleton robot, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of the exoskeleton robot control method when executing the computer program.
[0014] A fourth aspect of the present application provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the steps of the above-mentioned exoskeleton robot control method.
[0015] In summary, the exoskeleton robot control method, device, exoskeleton robot and storage medium provided by the present application determine the corresponding calf and thigh configuration lengths according to the user's physiological data, the exoskeleton robot's thigh coefficient, calf coefficient and height coefficient, thereby ensuring that the exoskeleton robot can closely fit the user's body size and improve the comfort and stability of wearing. After determining the calf and thigh configuration lengths, the precise motor control voltage is calculated by obtaining the motor control parameters and the lead screw moving distance, thereby achieving precise control of the extension and retraction of the lead screw motor, so that the exoskeleton robot can be accurately adjusted to the size required by the user, improving the overall control accuracy. BRIEF DESCRIPTION OF THE DRAWINGS
[0016] Figure 1 is a flow chart of an exoskeleton robot control method shown in an embodiment of the present application; Figure 2 is a flow chart of a method for controlling an exoskeleton robot thigh shown in an embodiment of the present application; Figure 3 is a flow chart of a method for controlling the lower leg of an exoskeleton robot shown in an embodiment of the present application; Figure 4 is a functional module diagram of an exoskeleton robot control device shown in an embodiment of the present application; Figure 5 It is a schematic diagram of the structure of a control unit of an exoskeleton robot shown in an embodiment of the present application. DETAILED DESCRIPTION
[0017] The present invention is further described below in conjunction with the accompanying drawings and embodiments.
[0018] The following will clearly and completely describe the concept, specific structure and technical effects of the present invention in combination with the embodiments and drawings, so as to fully understand the purpose, characteristics and effects of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of them. Based on the embodiments of the present invention, other embodiments obtained by technicians in this field without creative work are all within the scope of protection of the present invention. In addition, all the connection / connection relationships involved in the patent do not refer to the direct connection of components, but refer to the formation of a better connection structure by adding or reducing connection accessories according to the specific implementation situation. The various technical features in the invention can be combined interchangeably without conflicting with each other.
[0019] Reference Figure 1 As shown, it is a flow chart of an exoskeleton robot control method shown in an embodiment of the present application, and the exoskeleton robot includes the following steps.
[0020] S11, upon receiving the physiological data of the target user, determining the thigh coefficient, calf coefficient and height coefficient of the exoskeleton robot.
[0021] In some embodiments, the target user refers to any wearer who needs to use the exoskeleton robot for rehabilitation treatment. The physiological data may include, but is not limited to: height parameters, weight parameters and body mass parameters (BodyMass Index, BMI), etc. The user can input the corresponding height parameters and weight parameters through the human-computer interaction interface provided by the exoskeleton robot, and the control unit of the exoskeleton robot can calculate the corresponding BMI parameters according to the height parameters and weight parameters input by the user. In addition, the control unit of the exoskeleton robot can also use its corresponding sensor module to collect the user's physiological data. For example, the exoskeleton robot can use the infrared sensor installed on its head to collect the user's height parameters, use the pressure sensor installed on its soles to collect the user's weight parameters, and use the fat tester in its left and right handles to collect the user's BMI parameters. Specifically, when the user puts on the exoskeleton robot, the exoskeleton robot stands, and the user grabs the left and right hand handles with his hands. The left and right electrodes of the fat tester sensor in the handle will collect the user's BMI, and the pressure sensor on the soles of the feet will collect the user's weight parameters.
[0022] When receiving the physiological data input by the user or the physiological data collected by the user, the control unit of the exoskeleton robot further obtains the thigh coefficient, calf coefficient and height coefficient of the exoskeleton robot for subsequent calculation. Among them, the thigh coefficient, calf coefficient and height coefficient of the exoskeleton robot are determined based on multiple experiments and specific robots. Specifically, first collect the human body data of a large number of user groups, such as height parameters, thigh length, calf length, etc. For the collected human body data, calculate the ratio of each user's thigh length to height parameters and the ratio of calf length to height parameters. Then, use statistical methods (such as mean, standard deviation, median, etc.) to analyze the above ratios and determine an adapted thigh coefficient, calf coefficient and height coefficient. Further use the model pre-trained based on machine learning for verification, and verify the universal applicability of the selected thigh coefficient, calf coefficient and height coefficient by comparing the coefficient differences of different user groups (such as gender, age, region, etc.), and finally output a thigh coefficient, a calf coefficient and a height coefficient. Finally, after multiple functional tests on the exoskeleton robot, evaluate whether its motion performance, stability, etc. meet expectations. According to the test results and user feedback, the thigh coefficient, calf coefficient or height coefficient is adjusted to optimize the overall performance of the exoskeleton robot, that is, the values of the thigh coefficient, calf coefficient and height coefficient are finally determined.
[0023] S12, determining the thigh configuration length of the exoskeleton robot according to the physiological data, the thigh coefficient and the height coefficient, and determining the calf configuration length of the exoskeleton robot according to the physiological data, the calf coefficient and the height coefficient.
[0024] In some embodiments, after obtaining the user's physiological data and the thigh coefficient, calf parameters and height coefficient used for configuration of the exoskeleton robot, the control unit of the exoskeleton robot can determine the required calf and thigh configuration length corresponding to the target user based on the physiological data, thigh coefficient, calf coefficient and height coefficient.
[0025] Specifically, the control unit of the exoskeleton robot can determine the body coefficient corresponding to the target user according to the height parameter, weight parameter and BMI parameter of the target user. : ; Among them, h is the height parameter in the physiological data, W is the weight parameter in the physiological data; BMI is the BMI parameter in the physiological data.
[0026] After determining the body coefficient of the target user, the control unit of the exoskeleton robot can determine the thigh configuration length of the exoskeleton robot based on the body coefficient, thigh coefficient and height coefficient. : ; in, is the thigh coefficient, and H is the height coefficient.
[0027] In some embodiments, according to the same implementation as step S11, the thigh coefficient It can be taken as 0.341, and the height coefficient H can be taken as 155.
[0028] In addition, after determining the body coefficient of the target user, the control unit of the exoskeleton robot can determine the calf configuration length of the exoskeleton robot based on the body coefficient, calf coefficient and height coefficient. : ; in, is the calf coefficient.
[0029] In some embodiments, according to the same implementation as step S11, the calf coefficient You can take 0.21.
[0030] Through the above-mentioned optional implementation mode, by comprehensively considering the user's physiological data (such as height, weight, BMI) and specific coefficients (thigh coefficient, calf coefficient, height coefficient), the configuration length of the exoskeleton robot's thigh and calf can be accurately calculated, which not only improves the compatibility of the exoskeleton robot and the user, but also enhances the comfort and functionality of use.
[0031] S13, controlling the thigh of the exoskeleton robot to extend and retract according to the thigh configuration length, and controlling the calf of the exoskeleton robot to extend and retract according to the retractable calf configuration length.
[0032] In some embodiments, after determining the configuration lengths of the thigh and calf in the exoskeleton robot, the control unit of the exoskeleton robot can control the corresponding thigh to extend and retract according to the thigh configuration length to adapt to the thigh of the target user, and control the corresponding calf to extend and retract according to the calf configuration length to adapt to the calf of the target user. Specifically, the thigh and calf of the exoskeleton robot are respectively provided with a screw motor for driving the corresponding thigh and calf to extend and retract.
[0033] In some embodiments, the control unit of the exoskeleton robot can control the exoskeleton robot's thigh to extend and retract according to the thigh configuration length alone, or control the exoskeleton robot's calf to extend and retract according to the retractable calf configuration length. It is also possible to control the exoskeleton robot's calf to extend and retract according to the retractable calf configuration length while controlling the exoskeleton robot's thigh to extend and retract according to the thigh configuration length. In an optional embodiment, controlling the thigh of the exoskeleton robot to extend and retract according to the configured length of the thigh includes: Obtaining motor control parameters and lead screw moving distance of the lead screw motor of the exoskeleton robot at the current moment; Determining a motor control voltage of the lead screw motor according to the motor control parameter and the lead screw moving distance; The lead screw motor is controlled to extend and retract according to the motor control voltage, so that the thigh of the exoskeleton robot is extended and retracted.
[0034] At the current moment, when the thigh needs to be extended and retracted, the control unit of the exoskeleton robot can obtain the motor control parameters and the screw moving distance of the thigh's screw motor respectively. Among them, the motor control parameters are calculated by the maximum adjustable distance of the thigh and calf and the number of pulses of the encoder of the corresponding screw motor, and the screw moving distance can be obtained by the encoder set in the screw motor. Specifically, the maximum adjustable distance of the thigh and calf of the exoskeleton robot is 100mm, and the corresponding encoder of the screw motor generates 3800 pulses at this time, then the motor control parameter = 3800 / 100 = 38.
[0035] After determining the motor control parameters of the lead screw motor and the lead screw moving distance, the control unit of the exoskeleton robot can determine the corresponding motor control voltage based on the motor control parameters of the lead screw motor and the lead screw moving distance. : ; in, is the motor control voltage, is the control ratio parameter of the screw motor, which is used to adjust the running speed of the screw motor to avoid the situation where the left and right legs are at different heights during simultaneous control. e(t) is the difference between the actual length of the thigh of the exoskeleton robot at the current moment and the thigh position of the configured length of the thigh; The control unit of the exoskeleton robot can determine the thigh position difference e(t) through the motor control parameters and the lead screw moving distance: ; in, are the motor control parameters, is the moving distance of the lead screw.
[0036] After the motor control voltage of the lead screw motor of the thigh of the exoskeleton robot is determined, the thigh lead screw drive can be controlled according to the motor control voltage of the thigh lead screw motor, that is, the thigh lead screw motor can be controlled to extend and retract, so that the thigh of the exoskeleton robot can be extended and retracted.
[0037] When it is necessary to control the extension and retraction of the calf, according to the same embodiment as above, the control unit of the exoskeleton robot can determine the motor control voltage of the screw motor corresponding to its calf, and control the calf screw motor drive according to the motor control voltage of the calf screw motor, that is, control the extension and retraction of the calf screw motor, so that the calf of the exoskeleton robot can be extended and retracted.
[0038] In an optional implementation, controlling the lead screw motor to extend and retract according to the motor control voltage includes: When it is determined that the motor control voltage is greater than 0, controlling the lead screw motor to extend; When it is determined that the motor control voltage is less than 0, controlling the lead screw motor to retract; When it is determined that the motor control voltage is equal to 0, the operation of extending and retracting the lead screw motor is not performed.
[0039] In some embodiments, after determining the motor control voltage of the corresponding lead screw motor, the control unit of the exoskeleton robot can determine whether the motor control voltage is greater than 0. When it is determined that the motor control voltage is greater than 0, the control unit of the exoskeleton robot can send a positive voltage signal to the driver of the corresponding lead screw motor, so that after receiving the positive voltage signal, the driver drives the lead screw motor to perform an extension movement, thereby driving the joint or component to expand outward to reach the thigh configuration length or the calf configuration length. When it is determined that the motor control voltage is less than 0, the control unit of the exoskeleton robot can send a negative voltage signal to the driver of the lead screw motor, so that after receiving the negative voltage signal, the driver drives the lead screw motor to perform a contraction movement, thereby driving the joint or component to contract inward to reach the thigh configuration length or the calf configuration length. When it is determined that the motor control voltage is equal to 0, the control unit of the exoskeleton robot does not send any voltage signal to the driver of the lead screw motor, or sends a stop signal to the driver of the lead screw motor, so that after receiving the stop signal, the driver will stop supplying power to the lead screw motor, so that the lead screw motor remains in the current position without any telescopic movement.
[0040] Through the above optional implementation, the appropriate motor control voltage is calculated by the motor control parameters and the moving distance of the lead screw to control the extension and retraction of the motor, so as to accurately adjust the length of the thigh and calf of the exoskeleton robot, and by accurately controlling the motor control voltage of the lead screw motor, the length of the thigh and calf of the exoskeleton robot is dynamically adjusted to adapt to the leg length of different users. Secondly, the extension and retraction direction of the motor is determined according to the positive and negative of the motor control voltage, and the motor action is stopped when the voltage is zero, which improves the stability and response speed of the system.
[0041] In some embodiments, the control unit of the exoskeleton robot can control its thigh and calf separately, or can control its thigh and calf simultaneously. That is, the exoskeleton robot can control the left thigh separately, can control the right thigh separately, can control the left calf separately, and can control the right calf separately. In addition, the exoskeleton robot can also control the left thigh and the left calf simultaneously, can also control the right thigh and the right calf simultaneously, and can also control the left thigh, the left calf, the right thigh and the right calf simultaneously. Any permutation and combination in which the thighs and calves can be controlled separately or simultaneously should be applicable to the present application, and the present application will no longer give examples one by one.
[0042] In an optional embodiment, the method further comprises: When receiving the left thigh control signal, the left calf control signal, the right thigh control signal and the right calf control signal of the exoskeleton robot, determining the left thigh control voltage corresponding to the left thigh control signal, the left calf control voltage corresponding to the left calf control signal, the right thigh control voltage corresponding to the right thigh control signal and the right calf control voltage corresponding to the right calf control signal; Determine the left and right thigh control errors of the exoskeleton robot according to the left thigh control voltage and the right thigh control voltage, and determine the left and right calf control errors of the exoskeleton robot according to the left calf control voltage and the right calf control voltage; The left and right legs of the exoskeleton robot are controlled to extend and retract according to the left and right thigh control errors and the left and right calf control errors.
[0043] It should be clear that the left thigh, left calf, right thigh and right calf of the exoskeleton robot are allocated with screw motors for controlling extension and retraction. The screw motor corresponding to the left thigh is called the left thigh screw motor, the screw motor corresponding to the left calf is called the left calf screw motor, the screw motor corresponding to the right thigh is called the right thigh screw motor, and the screw motor corresponding to the right calf is called the right calf screw motor.
[0044] In some embodiments, according to the same embodiment as above, the control unit of the exoskeleton robot can calculate its corresponding left thigh configuration length, left calf configuration length, right thigh configuration length and right calf configuration length, and determine the left thigh control voltage of the left thigh lead screw motor according to the left thigh configuration length, determine the left calf control voltage of the left calf lead screw motor according to the left calf configuration length, determine the right thigh control voltage of the right thigh lead screw motor according to the right thigh configuration length, and determine the right calf control voltage of the right calf lead screw motor according to the right calf configuration length. In other embodiments, after calculating its corresponding left thigh configuration length, left calf configuration length, right thigh configuration length and right calf configuration length, the exoskeleton robot can also generate a corresponding left thigh control signal according to the left thigh configuration length, and send the left thigh control signal to the left thigh lead screw motor, so that the left thigh lead screw motor starts to control its lead screw to extend and retract. At this time, the exoskeleton robot can collect the lead screw change value (lead screw movement distance) of the encoder of the lead screw motor, and further calculate the left thigh control voltage according to the same embodiment as above. The left calf configuration length is similarly used to obtain the left calf control voltage, the right thigh configuration length is similarly used to obtain the right thigh control voltage, and the right calf configuration length is similarly used to obtain the right calf control voltage.
[0045] In some embodiments, when the lengths of the user's left and right legs are inconsistent, the user can choose to control the left and right legs separately. The user can choose to control separately through the separate control instructions provided by the exoskeleton robot (human-computer exchange interface, adjustment buttons on the calves and thighs, and voice commands, etc.) to adapt to the user's calf length.
[0046] When controlling separately, after determining the left thigh control voltage, the control unit of the exoskeleton robot sends the left thigh control signal carrying the left thigh control voltage to the left thigh screw motor, so that the left thigh screw motor can be driven according to the left thigh control voltage. After determining the left calf control voltage, the exoskeleton robot sends the left calf control signal carrying the left calf control voltage to the left calf screw motor, so that the left calf screw motor can be driven according to the left calf control voltage. After determining the right thigh control voltage, the exoskeleton robot sends the right thigh control signal carrying the right thigh control voltage to the right thigh screw motor, so that the right thigh screw motor can be driven according to the left thigh control voltage. After determining the right calf control voltage, the exoskeleton robot sends the right calf control signal carrying the right calf control voltage to the right calf screw motor, so that the right calf screw motor can be driven according to the right calf control voltage.
[0047] When controlling simultaneously, after obtaining the left thigh control voltage, left calf control voltage, right thigh control voltage and right calf control voltage, the exoskeleton robot also needs to calculate the difference between the left thigh control voltage and the right thigh control voltage, that is, the left and right thigh control error = left thigh control voltage - right thigh control voltage. When the left and right thigh control error is greater than 0, it means that the right thigh control extension speed is slower than the left thigh control extension speed, then adjust the control ratio parameter of the left thigh lead screw motor (First control ratio parameter), that is, reduce the first control ratio parameter, so that the control speed of the left thigh lead screw motor is slowed down, so that the left thigh control voltage is reduced, until the left and right thigh control error is 0. When the right thigh control error is less than 0, it means that the right thigh control extension speed is faster than the left thigh control extension speed, then adjust the control ratio parameter of the right thigh lead screw motor (Second control proportional parameter), that is, reducing the second control proportional parameter, thereby slowing down the control speed of the right thigh lead screw motor, so that the right thigh control voltage is reduced until the control error between the left and right thighs is 0.
[0048] For example, when adjusting the left thigh at time t, assuming that the left thigh is adjusted by 10cm and the right thigh is 5cm at this time, the left and right thighs are of different lengths. In this case, the adjustment speed of the left thigh can be slowed down at the current moment until the right thigh is also adjusted to 10cm, or at the next moment, the left thigh is adjusted by 20cm at the same time. In the embodiment of the present application, the stop mode, i.e. the waiting adjustment mode, is used. Set to 1 or 0.
[0049] Similarly, the exoskeleton robot also needs to calculate the difference between the left calf control voltage and the right calf control voltage, that is, the left and right calf control error = left calf control voltage - right calf control voltage. When the left and right calf control error is greater than 0, it means that the right calf control extension speed is slower than the left calf control extension speed, then adjust the control ratio parameter of the left calf lead screw motor (the third control ratio parameter), that is, reduce the third control ratio parameter, so that the control speed of the left calf screw motor is slowed down, so that the left calf control voltage is reduced until the left and right calf control error is 0. When the right calf control error is less than 0, it means that the right calf control extension speed is faster than the left calf control extension speed, then adjust the control ratio parameter of the right calf screw motor (Fourth control proportional parameter), that is, reducing the fourth control proportional parameter, thereby slowing down the control speed of the right calf lead screw motor, so that the right calf control voltage is reduced until the left and right calf control error is 0.
[0050] Through the above optional implementation, personalized adaptation and dynamic balance adjustment are achieved by precisely controlling the extension and retraction of the left and right legs of the exoskeleton robot. Not only can the robot be controlled separately according to the difference in the length of the left and right legs of the user, but it can also ensure the synchronous extension and retraction of the left and right legs by calculating the control error and dynamically adjusting the motor control ratio parameters, thereby improving the comfort and stability of the wearer.
[0051] Refer to Figure 2 When it is necessary to control the thigh of the exoskeleton robot separately, the control unit of the exoskeleton robot can obtain the physiological data of the target user, and the thigh coefficient and height coefficient of the exoskeleton robot. According to the same embodiment as above, the control unit of the exoskeleton robot can calculate the thigh configuration length based on the physiological data, the thigh coefficient and the height coefficient. Further, the control unit of the exoskeleton robot can send a thigh control signal carrying the thigh configuration length to the thigh screw motor to make the thigh screw motor extend and retract.
[0052] Refer to Figure 3 When the calf of the exoskeleton robot needs to be controlled separately, the control unit of the exoskeleton robot can obtain the physiological data of the target user, and the calf coefficient and height coefficient of the exoskeleton robot. According to the same embodiment as above, the control unit of the exoskeleton robot can calculate the calf configuration length based on the physiological data, the calf coefficient and the height coefficient. Further, the control unit of the exoskeleton robot can send a calf control signal carrying the calf configuration length to the calf screw motor to make the calf screw motor extend and retract.
[0053] Reference Figure 4, which is a functional module diagram of an exoskeleton robot control device shown in an embodiment of the present application.
[0054] In some embodiments, the exoskeleton robot control device 40 may include a plurality of functional modules composed of computer program segments. The computer programs of the various program segments of the exoskeleton robot control device 40 may be stored in a memory of an electronic device and executed by at least one processor to perform (see Figure 1 Description) Data management capabilities.
[0055] In this embodiment, the exoskeleton robot control device 40 can be divided into multiple functional modules according to the functions it performs. The functional modules may include: a first determination module 401, a second determination module 402 and a control module 403. The module referred to in this application refers to a series of computer program segments that can be executed by at least one processor and can complete fixed functions, which are stored in a memory. In this embodiment, the functions of each module will be described in detail in subsequent embodiments.
[0056] The first determination module 401 is used to determine the thigh coefficient, calf coefficient and height coefficient of the exoskeleton robot when receiving the physiological data of the target user; The second determination module 402 is used to determine the thigh configuration length of the exoskeleton robot according to the physiological data, the thigh coefficient and the height coefficient, and to determine the calf configuration length of the exoskeleton robot according to the physiological data, the calf coefficient and the height coefficient; The control module 403 is used to control the thigh of the exoskeleton robot to extend and retract according to the configured length of the thigh, and to control the calf of the telescopic exoskeleton robot to extend and retract according to the configured length of the telescopic calf.
[0057] The second determining module 402 is further specifically configured to: The thigh configuration length is determined by the following formula: ; in, configuring a length for said thigh, is the body coefficient, is the thigh coefficient, H is the height coefficient; The body coefficient is determined by the following formula: ; Among them, h is the height parameter table in the physiological data, W is the weight parameter in the physiological data, and BMI is the BMI parameter in the physiological data.
[0058] The second determining module 402 is further specifically configured to: The calf configuration length is determined by the following formula: ; in, configuring a length for said thigh, is the calf coefficient.
[0059] The control module 403 is also specifically used to: obtain the motor control parameters and the screw moving distance of the screw motor of the exoskeleton robot at the current moment; determine the motor control voltage of the screw motor according to the motor control parameters and the screw moving distance; control the screw motor to extend and retract according to the motor control voltage, so that the thigh of the exoskeleton robot can be extended and retracted.
[0060] The control module 403 is also specifically used to: when it is determined that the motor control voltage is greater than 0, control the lead screw motor to extend; when it is determined that the motor control voltage is less than 0, control the lead screw motor to retract; when it is determined that the motor control voltage is equal to 0, do not perform the operation of extending or retracting the lead screw motor.
[0061] The control module 403 is also specifically used for: when receiving the left thigh control signal, left calf control signal, right thigh control signal and right calf control signal of the exoskeleton robot, determining the left thigh control voltage corresponding to the left thigh control signal, the left calf control voltage corresponding to the left calf control signal, the right thigh control voltage corresponding to the right thigh control signal and the right calf control voltage corresponding to the right calf control signal; determining the left and right thigh control errors of the exoskeleton robot according to the left thigh control voltage and the right thigh control voltage, and determining the left and right calf control errors of the exoskeleton robot according to the left calf control voltage and the right calf control voltage; and controlling the left and right legs of the exoskeleton robot to extend and retract according to the left and right thigh control errors and the left and right calf control errors.
[0062] The control module 403 is also specifically used for: when the left and right thigh control error is greater than 0, adjusting the first control ratio parameter of the left thigh lead screw motor of the exoskeleton robot so that the left thigh control voltage is reduced until the left and right thigh control error is equal to 0; when the left and right thigh control error is less than 0, adjusting the second control ratio parameter of the right thigh lead screw motor of the exoskeleton robot so that the right thigh control voltage is reduced until the left and right thigh control error is equal to 0; when the left and right calf control error is greater than 0, adjusting the third control ratio parameter of the left calf lead screw motor of the exoskeleton robot so that the left calf control voltage is reduced until the left and right calf control error is equal to 0; when the left and right calf control error is less than 0, adjusting the fourth control ratio parameter of the right calf lead screw motor of the exoskeleton robot so that the right calf control voltage is reduced until the left and right calf control error is equal to 0.
[0063] It should be understood that the various variations and specific embodiments of the exoskeleton robot control method provided in the above-mentioned embodiments are also applicable to the exoskeleton robot control device of the present embodiment. Through the above-mentioned detailed description of the exoskeleton robot control method, those skilled in the art can clearly know the implementation method of the exoskeleton robot control device of the present embodiment. For the sake of brevity of the specification, it will not be described in detail here.
[0064] See also Figure 5 FIG. 1 is a schematic diagram of the structure of a control unit of an exoskeleton robot shown in an embodiment of the present application. In a preferred embodiment of the present application, the control unit 5 includes a memory 51 , at least one processor 52 and at least one communication bus 53 .
[0065] Those skilled in the art should understand that Figure 5 The structure of the control unit shown does not constitute a limitation of the embodiments of the present application, and may also include more or less other hardware or software than shown in the figure, or a different arrangement of components.
[0066] The components described as separate components may or may not be physically separated, and the components shown as components may or may not be physical modules, that is, they may be located in one place or distributed on multiple network modules. Some or all of the components may be selected according to actual needs to achieve the purpose of the solution of this embodiment.
[0067] In addition, each functional module in each embodiment of the present invention may be integrated into one processing module, or each component may exist physically separately, or two or more modules may be integrated into one module. The above integrated modules may be implemented in the form of hardware or in the form of software functional modules.
[0068] If the integrated module is implemented in the form of a software function module and sold or used as an independent product, it can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, in essence, or the part that contributes to the prior art, or all or part of the technical solution can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk, etc. Various media that can store program codes.
[0069] It should be noted that, for the convenience of description, the aforementioned method embodiments are all described as a series of action combinations, but those skilled in the art should be aware that the present invention is not limited by the described action sequence, because according to the present invention, certain steps can be performed in other sequences or simultaneously. Secondly, those skilled in the art should also be aware that the embodiments described in the specification are all preferred embodiments, and the actions and modules involved are not necessarily required by the present invention.
[0070] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.
[0071] The above is a specific description of the preferred implementation of the present invention, but the invention is not limited to the embodiments. Those skilled in the art can make various equivalent modifications or substitutions without violating the spirit of the present invention. These equivalent modifications or substitutions are all included in the scope defined by the claims of this application.
Claims
1. A control method for an exoskeleton robot, It is characterized in that The method comprises: When receiving the physiological data of the target user, determining the thigh coefficient, calf coefficient and height coefficient of the exoskeleton robot; Determine the thigh configuration length of the exoskeleton robot according to the physiological data, the thigh coefficient and the height coefficient, and determine the calf configuration length of the exoskeleton robot according to the physiological data, the calf coefficient and the height coefficient; The thigh of the exoskeleton robot is controlled to be extended and retracted according to the thigh configuration length, and the calf of the exoskeleton robot is controlled to be extended and retracted according to the retractable calf configuration length.
2. The exoskeleton robot control method according to claim 1, It is characterized in that The determining of the thigh configuration length of the exoskeleton robot according to the physiological data, the thigh coefficient and the height coefficient comprises: The thigh configuration length is determined by the following formula: ; in, configuring a length for said thigh, is the body coefficient, is the thigh coefficient, H is the height coefficient; The body coefficient is determined by the following formula: ; Among them, h is the height parameter table in the physiological data, W is the weight parameter in the physiological data, and BMI is the BMI parameter in the physiological data.
3. The exoskeleton robot control method according to claim 2, It is characterized in that Determining the calf configuration length of the exoskeleton robot according to the physiological data, the calf coefficient and the height coefficient includes: The calf configuration length is determined by the following formula: ; in, configuring a length for said thigh, is the calf coefficient.
4. The exoskeleton robot control method according to claim 1, It is characterized in that The step of controlling the thigh of the exoskeleton robot to extend and retract according to the thigh configuration length comprises: Obtaining motor control parameters and lead screw moving distance of the lead screw motor of the exoskeleton robot at the current moment; Determining a motor control voltage of the lead screw motor according to the motor control parameter and the lead screw moving distance; The lead screw motor is controlled to extend and retract according to the motor control voltage, so that the thigh of the exoskeleton robot is extended and retracted.
5. The exoskeleton robot control method according to claim 4, It is characterized in that Controlling the lead screw motor to extend and retract according to the motor control voltage comprises: When it is determined that the motor control voltage is greater than 0, controlling the lead screw motor to extend; When it is determined that the motor control voltage is less than 0, controlling the lead screw motor to retract; When it is determined that the motor control voltage is equal to 0, the operation of extending and retracting the lead screw motor is not performed.
6. The exoskeleton robot control method according to any one of claims 1 to 5, It is characterized in that The method further comprises: When receiving the left thigh control signal, the left calf control signal, the right thigh control signal and the right calf control signal of the exoskeleton robot, determining the left thigh control voltage corresponding to the left thigh control signal, the left calf control voltage corresponding to the left calf control signal, the right thigh control voltage corresponding to the right thigh control signal and the right calf control voltage corresponding to the right calf control signal; Determine the left and right thigh control errors of the exoskeleton robot according to the left thigh control voltage and the right thigh control voltage, and determine the left and right calf control errors of the exoskeleton robot according to the left calf control voltage and the right calf control voltage; The left and right legs of the exoskeleton robot are controlled to extend and retract according to the left and right thigh control errors and the left and right calf control errors.
7. The exoskeleton robot control method according to claim 6, It is characterized in that The step of controlling the left and right legs of the exoskeleton robot to extend and retract according to the left and right thigh control errors and the left and right calf control errors comprises: When the left and right thigh control error is greater than 0, adjusting the first control proportional parameter of the left thigh lead screw motor of the exoskeleton robot so that the left thigh control voltage is reduced until the left and right thigh control error is equal to 0; When the left and right thigh control error is less than 0, adjusting the second control proportional parameter of the right thigh lead screw motor of the exoskeleton robot so that the right thigh control voltage is reduced until the left and right thigh control error is equal to 0; When the left and right calf control error is greater than 0, adjusting the third control ratio parameter of the left calf lead screw motor of the exoskeleton robot so that the left calf control voltage decreases until the left and right calf control error is equal to 0; When the left and right calf control error is less than 0, the fourth control proportional parameter of the right calf lead screw motor of the exoskeleton robot is adjusted to reduce the right calf control voltage until the left and right calf control error is equal to 0.
8. An exoskeleton robot control device, It is characterized in that The device comprises: The first determination module is used to determine the thigh coefficient, calf coefficient and height coefficient of the exoskeleton robot when receiving the physiological data of the target user; a second determination module, configured to determine a thigh configuration length of the exoskeleton robot according to the physiological data, the thigh coefficient and the height coefficient, and to determine a calf configuration length of the exoskeleton robot according to the physiological data, the calf coefficient and the height coefficient; The control module is used to control the extension and retraction of the thigh of the exoskeleton robot according to the configuration length of the thigh, and to control the extension and retraction of the calf of the telescopic exoskeleton robot according to the configuration length of the telescopic calf.
9. An exoskeleton robot, It is characterized in that The method comprises a memory, a processor and a computer program stored in the memory and executable on the processor, wherein when the processor executes the computer program, the steps of the exoskeleton robot control method according to any one of claims 1 to 7 are implemented.
10. A computer-readable storage medium having a computer program stored thereon, It is characterized in that When the computer program is executed by a processor, the steps of the exoskeleton robot control method according to any one of claims 1 to 7 are implemented.
