Robot control method, robot and storage medium
By using a combination of attitude sensors and driving mechanisms in the robot to control the linear motion and rotation of the mechanical legs, the problems of robot balance and speed in the prior art are solved, and a more flexible and stable walking ability is achieved.
Patent Information
- Application Number
- CN202410171137.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-02-06
- Publication Date
- 2024-12-03
AI Technical Summary
Existing leg retractable robots require a large amount of expansion during obstacle crossing, resulting in complex link structure, difficult to control balance, and slow forward speed.
By adopting a control method including a fuselage, a posture sensor, a mechanical leg and a driving mechanism, by obtaining the attitude information of the robot, the first driving mechanism controls the rotation of the mechanical leg relative to the fuselage and the second leg mechanism is straightened with the first leg mechanism. Move, change the center of gravity to maintain balance.
The robot's self-balancing control is realized, which improves stability and adaptability, enables it to maintain a balanced state in different environments, and improves the accuracy and response speed of movement.
Smart Images

Figure CN119065393A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of robot technology, and in particular to a robot control method, a robot and a storage medium. Background Art
[0002] With the advancement of science and technology, the application of robots is becoming more and more common. Among them, robots with retractable legs are widely used in the field of automation.
[0003] Existing robots with retractable legs mainly use a link structure, such as a four-link or five-link multi-link structure, to achieve leg retraction and adjustment, so as to adjust the distance between the body and the legs, enhance its obstacle crossing ability, and realize robot walking.
[0004] However, in order to overcome obstacles, the robot's legs need to have a large extension and retraction range, which means that the link structure needs to include multiple links and hinges. When the legs change length, the link angle changes continuously, making the robot's balance difficult to control and its forward speed relatively slow. Summary of the invention
[0005] The present application provides a robot control method, a robot and a storage medium, aiming at achieving self-balancing of the robot during standing or moving.
[0006] To achieve the above-mentioned object, the present application provides a control method for a robot, the robot comprising a body, a posture sensor arranged on the body, at least two mechanical legs and at least two first driving mechanisms, the mechanical legs are rotatably connected to the body, the mechanical legs comprise a first leg mechanism and a second leg mechanism, the first driving mechanism is configured to be able to drive the second leg mechanism to perform linear motion relative to the first leg mechanism, and to drive the mechanical legs to rotate relative to the body; the control method comprises:
[0007] Acquire posture information of the robot, wherein the posture information includes at least one of pitch angle information and roll angle information;
[0008] According to the posture information, the first driving mechanism is used to control the mechanical leg to rotate relative to the body; and / or, according to the posture information, the first driving mechanism is used to control the second leg mechanism to move linearly relative to the first leg mechanism; so as to change the center of gravity of the robot, thereby allowing the robot to maintain balance on the supporting surface where the robot is located.
[0009] In addition, to achieve the above-mentioned purpose, the present application also provides a robot, comprising: a memory and a processor; wherein the memory is connected to the processor and is used to store programs; the processor is used to implement the steps of the robot control method as described in any one of the embodiments of the present application by running the programs stored in the memory.
[0010] In addition, to achieve the above-mentioned purpose, the present application also provides a computer-readable storage medium, which stores a computer program. When the computer program is executed by a processor, the processor enables the processor to implement the steps of the robot control method described in any one of the embodiments of the present application.
[0011] The control method, robot and storage medium of the robot disclosed in the embodiment of the present application, the robot includes a fuselage, a posture sensor arranged on the fuselage, at least two mechanical legs and at least two first driving mechanisms, the mechanical legs are connected to the fuselage in rotation, the mechanical legs include a first leg mechanism and a second leg mechanism, the first driving mechanism is configured to be able to drive the second leg mechanism to make a linear motion relative to the first leg mechanism, and drive the mechanical legs to rotate relative to the fuselage; the control method includes: obtaining the posture information of the robot, the posture information includes at least one of the pitch angle information and the roll angle information; according to the posture information, the mechanical leg is controlled to rotate relative to the fuselage through the first driving mechanism; and / or, according to the posture information, the second leg mechanism is controlled to make a linear motion relative to the first leg mechanism through the first driving mechanism; so as to change the center of gravity of the robot, thereby making the robot maintain balance on the support surface where the robot is located. Compared with the prior art, the present application can realize more flexible control of the robot, thereby helping to improve the stability and adaptability of the robot, so that it can maintain a balanced state in different environments. BRIEF DESCRIPTION OF THE DRAWINGS
[0012] In order to more clearly illustrate the technical solutions of the embodiments of the present application, the drawings required for use in the description of the embodiments will be briefly introduced below. Obviously, the drawings described below are some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying any creative work.
[0013] Figure 1 is a schematic diagram of the structure of a robot provided in an embodiment of the present application;
[0014] Figure 2 is a schematic structural diagram of a mechanical leg of a robot provided in an embodiment of the present application;
[0015] Figure 3 A schematic diagram of the connection between the first transmission assembly, the second transmission assembly and the first leg mechanism provided in an embodiment of the present application;
[0016] Figure 4 A partially enlarged schematic diagram of the position of the foot of a mechanical leg provided in an embodiment of the present application;
[0017] Figure 5 A schematic diagram of the structure of the second leg mechanism provided in an embodiment of the present application;
[0018] Figure 6 This is a schematic diagram of the structure of the mechanical leg with hidden feet proposed in an embodiment of the present application.
[0019] Figure 7 This is a schematic diagram of the structure of the second driving mechanism proposed in an embodiment of the present application.
[0020] Figure 8 A schematic block diagram of the electrical connection of a robot proposed in an embodiment of the present application;
[0021] Fig. 9 It is a flowchart of a robot control method provided in an embodiment of the present application;
[0022] Fig.10 It is a schematic diagram of a flow chart of controlling a robot according to a leg length change speed and a rotation angle provided by an embodiment of the present application;
[0023] Fig.11 It is a schematic diagram of a flow chart of controlling the steering of a robot provided in an embodiment of the present application;
[0024] Fig.12 It is a schematic diagram of a flow chart of controlling a robot according to an inverted pendulum model provided in an embodiment of the present application;
[0025] Fig.13 It is a schematic block diagram of a robot provided in an embodiment of the present application.
[0026] Description of reference numerals:
[0027] 1000, robot; 100, mechanical leg; 200, body; 10, first leg mechanism; 20, second leg mechanism; 30, first driving mechanism; 21, posture sensor; 30a, first driving component; 30b, second driving component; 31, first motor; 321, first transmission wheel; 322, second transmission wheel; 323, first flexible transmission member; 32, second motor; 341, third transmission wheel; 342, fourth transmission wheel; 343, second flexible transmission member; 22, foot; 23, second driving mechanism; 2213, wheel; 222, third motor; 40, first limit member; 41, second limit member. DETAILED DESCRIPTION
[0028] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.
[0029] The flowcharts shown in the accompanying drawings are only examples and do not necessarily include all the contents and operations / steps, nor do they have to be executed in the order described. For example, some operations / steps can also be decomposed, combined or partially merged, so the actual execution order may change according to actual conditions. In addition, although the functional modules are divided in the device schematic, in some cases, the module division can be different from that in the device schematic.
[0030] The term "and / or" as used in this specification and the appended claims refers to and includes any and all possible combinations of one or more of the associated listed items.
[0031] In conjunction with the accompanying drawings, some embodiments of the present application are described in detail below. In the absence of conflict, the following embodiments and features in the embodiments can be combined with each other.
[0032] See also Figures 1 to 4 ,like Figures 1 to 4 As shown, the robot 1000 provided in the present application includes a body 200, a posture sensor 21 arranged on the body 200, at least two mechanical legs 100 and at least two first driving mechanisms 30, the mechanical legs 100 are rotatably connected to the body 200, the mechanical legs 100 include a first leg mechanism 10 and a second leg mechanism 20, and the first driving mechanism 30 is configured to be able to drive the second leg mechanism 20 to perform linear motion relative to the first leg mechanism 10, and to drive the mechanical legs 100 to rotate relative to the body 200.
[0033] Specifically, the first leg mechanism 10 is used to rotate and is connected to the body 200 of the robot 1000; the second leg mechanism 20 is slidably connected to the first leg mechanism 10, so that the second leg mechanism 20 can move linearly in a first direction relative to the first leg mechanism 10, and the first direction is the extension direction of the first leg mechanism 10; the first driving mechanism 30 is configured to be able to drive the first leg mechanism 10 and the second leg mechanism 20 to rotate as a whole relative to the body 200, and to drive the second leg mechanism 20 to move linearly in the first direction relative to the first leg mechanism 10, so as to assist the robot 1000 in maintaining self-balance when moving or standing.
[0034] It can be understood that the extension and retraction of the mechanical leg 100 is achieved by the relative linear motion of the second leg mechanism 20 and the first leg mechanism 10, so that sufficient extension and retraction can be achieved without increasing the lateral volume of the robot 1000, effectively improving the mobility of the robot 1000 in a limited space, and through the setting of linear extension and retraction, the load force arm of the power source of the first driving mechanism 30 is kept constant during the extension and retraction process of the mechanical leg 100, simplifying the control model, improving the accuracy and response speed of the movement of the robot 1000, and generally, the load force arm of the power source is shorter, and the power source power consumption is low. The first driving mechanism 30 drives the first leg mechanism 10 to rotate relative to the fuselage 200, and drives the second leg mechanism 20 to move linearly relative to the first leg mechanism 10, so as to assist the robot 1000 to maintain self-balance when walking or standing, thereby facilitating the self-balancing control of the robot 1000.
[0035] In addition, due to the linear telescopic arrangement between the first leg mechanism 10 and the second leg mechanism 20, the energy efficiency of the robot 1000 at any telescopic position is improved, thereby reducing energy consumption.
[0036] At the same time, due to the linear telescopic movement mode, the lever arm of the mechanical leg 100 remains unchanged during the telescopic process, that is, the load lever arm of the power source remains unchanged, and under normal circumstances, the load lever arm of the power source is shorter, the power source has low power consumption, strong load capacity and better stability.
[0037] It should be noted that in the prior art, when the legs of robots are connected by a connecting rod structure, the connecting rod angle is constantly changing during the extension and retraction process, and the force arm of the load on the power source is constantly changing, making the control model complex. For robots with a connecting rod structure, except when the legs are at their longest or close to their longest extension, their force arm is relatively short. Most of the time, the robot's legs have a certain extension and retraction amount, and are not at their longest state. Their force arm is always relatively long, and the robot consumes more energy when standing, walking, and retracting.
[0038] Moreover, the linear telescopic setting makes the appearance of the robot 1000 more compact, provides greater freedom for the appearance design of the robot 1000, and makes the robot 1000 more in line with humanization and aesthetic requirements.
[0039] In some embodiments, the first driving mechanism 30 has at least two driving states among a first driving state, a second driving state and a third driving state, and the first driving mechanism 30 can switch freely between at least two driving states; in the first driving state, the first driving mechanism 30 is used to drive the first leg mechanism 10 and the second leg mechanism 20 to rotate as a whole relative to the fuselage 200; in the second driving state, the first driving mechanism 30 is used to drive the second leg mechanism 20 to move linearly along the first direction relative to the first leg mechanism 10; in the third driving state, the first driving mechanism 30 is used to drive the first leg mechanism 10 and the second leg mechanism 20 to rotate as a whole relative to the fuselage 200, while driving the second leg mechanism 20 to move linearly along the first direction relative to the first leg mechanism 10.
[0040] Thus, the first driving mechanism 30 can freely switch between at least two driving states among the first driving state, the second driving state and the third driving state to maintain the self-balance of the robot 1000 .
[0041] In some embodiments, the first driving mechanism 30 includes a first driving member 30a and a second driving member 30b, and the first driving member 30a and the second driving member 30b are used to work together to drive the first leg mechanism 10 and the second leg mechanism 20 to rotate relative to the body 200 as a whole; the first driving member 30a and the second driving member 30b are also used to work together to drive the second leg mechanism 20 to move linearly along the first direction relative to the first leg mechanism 10. Therefore, the first driving member 30a and the second driving member 30b need to cooperate to drive the mechanical leg 100 to rotate or retract independently, or to perform a composite movement of rotation and retraction. The first driving member 30a and the second driving member 30b work together to cooperate to drive the mechanical leg 100 to rotate and / or retract, so that the power sources of the first driving member 30a and the second driving member 30b are connected in parallel, which can reduce the parameters required for the power source drive, reduce errors, improve the running speed of the robot 1000, and reduce the use cost.
[0042] In some embodiments, the first driving member 30a includes a first flexible transmission member 323, a first transmission wheel 321 and a second transmission wheel 322, the first transmission wheel 321 and the second transmission wheel 322 are used to be rotatably connected to the first leg mechanism 10 and are arranged at intervals along the first direction, the first flexible transmission member 323 is connected between the first transmission wheel 321 and the second transmission wheel 322 and is used to connect to the second leg mechanism 20; the second driving member 30b includes a second flexible transmission member 343, a third transmission wheel 341 and a fourth transmission wheel 342, the third transmission wheel 341 and the fourth transmission wheel 342 are used to be rotatably connected to the first leg mechanism 10 and are arranged at intervals along the first direction, the second flexible transmission member 343 is connected between the third transmission wheel 341 and the fourth transmission wheel 342 and is used to connect to the second leg mechanism 20.
[0043] During operation, when the first flexible transmission member 323 and the second flexible transmission member 343 rotate in opposite directions and at the same speed, the second leg mechanism 20 is driven to move linearly in the first direction relative to the first leg mechanism 10; the first flexible transmission member 323 and the second flexible transmission member 343 rotate in the same direction and at the same speed, so that the first leg mechanism 20 and the second leg mechanism 10 are rotated as a whole relative to the fuselage 200; the first flexible transmission member 323 and the second flexible transmission member 343 rotate in opposite directions and at different speeds, so that the second leg mechanism 20 is driven to move linearly in the first direction relative to the first leg mechanism 10, and the first leg mechanism 10 and the second leg mechanism 20 are rotated as a whole relative to the fuselage 200; the first flexible transmission member 323 and the second flexible transmission member 343 rotate in the same direction and at different speeds, so that the first leg mechanism 10 and the second leg mechanism 20 are driven to rotate as a whole relative to the fuselage 200, and the second leg mechanism 20 is moved linearly in the first direction relative to the first leg mechanism 10.
[0044] Optionally, the first flexible transmission member 323 and the second flexible transmission member 343 can be belts, ropes or other flexible transmission members, which can play a buffering role, reduce the impact of the impact force directly acting on the motor, and increase the durability and operational stability of the first drive mechanism 30.
[0045] In some embodiments, the first driving component 30a also includes a first motor 31, and the second driving component 30b includes a second motor 32. The first motor 31 and the second motor 32 are used to be connected to the body 200, and the first motor 31 and the second motor 32 are coaxially arranged. The first motor 31 is used to drive the first flexible transmission member 323 to rotate, and the second motor 32 is used to drive the second flexible transmission member 343 to rotate.
[0046] It can be understood that the first motor 31 and the second motor 32 rotate in opposite directions and with the same torque, so that the first flexible transmission member 323 and the second flexible transmission member 343 can rotate in opposite directions and at the same speed; the first motor 31 and the second motor 32 rotate in the same direction and with the same torque, so that the first flexible transmission member 323 and the second flexible transmission member 343 can rotate in the same direction and at the same speed; the first motor 31 and the second motor 32 rotate in opposite directions and with different torques, so that the first flexible transmission member 323 and the second flexible transmission member 343 can be driven to rotate in opposite directions and at different speeds; the first motor 31 and the second motor 32 rotate in the same direction and with different torques, so that the first flexible transmission member 323 and the second flexible transmission member 343 can be driven to rotate in the same direction and at different speeds.
[0047] In some embodiments, the robot 1000 further includes a foot 22 and a second driving mechanism 23 , wherein the foot 22 is connected to the second leg mechanism 23 for providing support when the robot 1000 is walking or standing, and the second driving mechanism 23 is configured to be able to drive the foot 22 to move.
[0048] In some embodiments, the foot 22 includes a wheel 2213 , and the second driving mechanism 23 includes a third motor 222 , and the third motor 222 is used to drive the wheel 2213 to rotate.
[0049] It should be noted that the foot 22 is not limited to the setting of the wheel 2213. For example, in other embodiments, the foot 22 can also adopt a structure similar to the sole of the foot to imitate the structure of the human foot. In this case, the walking of the robot 10000 needs to be controlled by the rotation and extension of the mechanical leg 100.
[0050] Of course, in some special cases, the foot 22 can also be a spherical structure, or a regular or irregular shape such as a planar structure directly arranged at the bottom of the second leg mechanism 20, which can abut against the supporting surface to play a supporting role without affecting the normal operation of the robot 1000.
[0051] In some embodiments, the robot 1000 also includes a first limiter 40 and a second limiter 41. The first limiter 40 is used to limit the rotation angle between the mechanical leg 100 and the body 200 to prevent the first leg mechanism 10 from rotating and transitioning, causing the first leg mechanism 10 to collide with other components and cause damage to parts; the second limiter 41 is used to limit the extension length of the mechanical leg 100 to prevent the second leg mechanism 20 from moving and transitioning, causing the second leg mechanism 20 to collide with other components and cause damage to parts.
[0052] It should also be noted that if Figure 8As shown, the robot 1000 provided in the embodiment of the present application may also include a circuit board and a battery arranged on the fuselage 200, the circuit board is electrically connected to the battery, and a circuit unit 300 for the circuit control part of the robot 1000 is arranged on the circuit board, and the circuit unit 300 mainly includes a controller. Among them, the posture sensor 21, the first drive mechanism 30 and the second drive structure 23 of the robot 1000 are all electrically connected to the controller. The controller is used to obtain relevant data or instructions, and execute various control programs or control instructions, thereby controlling the robot 1000 to perform corresponding actions.
[0053] The robot control method provided by the present application will be introduced below based on the robot 1000 provided in the above-mentioned embodiments. It should be noted that the robot control method provided by the present application can be applied to but not limited to the robot 1000 mentioned in the above-mentioned embodiments. The robot control method can be applied to any robot with linear motion and rotational motion, or a robot with decoupled control of three axes.
[0054] For example, this type of robot may include a body, a posture sensor disposed on the body, at least two mechanical legs and at least two first drive mechanisms, the mechanical legs are rotatably connected to the body, the mechanical legs include a first leg mechanism and a second leg mechanism, the first drive mechanism is configured to drive the second leg mechanism to perform linear motion relative to the first leg mechanism, and to drive the mechanical legs to rotate relative to the body. Of course, it is understandable that this type of robot may also include more other components, such as a mechanical arm, a hand or a head.
[0055] See also Fig. 9 , Fig. 9 1 is a flow chart of a robot control method provided in an embodiment of the present application. Fig. 9 As shown, the robot control method includes steps S11 to S12. The control method can be specifically applied to the controller of the robot.
[0056] Step S11: Acquire the posture information of the robot, where the posture information includes at least one of pitch angle information and roll angle information.
[0057] Specifically, the robot's angular velocity information and acceleration information can be obtained through attitude sensors (such as gyroscopes, accelerometers, visual sensors, etc.) installed on the body, and then the angular velocity information and acceleration information of the robot are fused through a preset algorithm to obtain the robot's pitch angle information, roll axis information and other attitude information.
[0058] It should be noted that the present application does not limit the preset algorithm, such as Kalman filtering, complementary filtering, quaternion filtering, etc. The present application takes Kalman filtering as an example for explanation.
[0059] Kalman filtering is a recursive algorithm that can be used to fuse information from different sensors to obtain a more accurate estimate. In the embodiment of the present application, the Kalman filter combines the information of the gyroscope and the accelerometer, taking into account the error and noise between the two, and then through continuous iteration, combining prior information and actual measurements, gradually improves the estimation accuracy of the robot's posture information, and has the advantages of strong adaptability and good real-time performance.
[0060] In an embodiment of the present application, a more accurate and stable estimation of the posture information can be obtained by combining the robot's angular velocity information and acceleration information with Kalman filtering while taking into account sensor errors and noise, which can then be used to more accurately control the robot.
[0061] Step S12: According to the posture information, the first driving mechanism is used to control the mechanical legs to rotate relative to the body; and / or, according to the posture information, the first driving mechanism is used to control the second leg mechanism to move linearly relative to the first leg mechanism; so as to change the center of gravity of the robot, thereby allowing the robot to maintain balance on the support surface where the robot is located.
[0062] Since the posture information of the robot can be used to indicate the tilt state of the robot itself, after obtaining the posture information of the robot, the first driving mechanism can be used to control the rotation of the mechanical legs relative to the body; and / or, the first driving mechanism can be used to control the second leg mechanism to make a linear motion relative to the first leg mechanism, so as to adjust the tilt state of the robot, thereby changing the center of gravity of the robot, so that the robot can maintain balance on the support surface on which it is located.
[0063] In the embodiment of the present application, the movement of the robot can be adjusted according to the current posture information of the robot, so that the robot can adjust its own tilt state in real time to maintain balance on the support surface.
[0064] Optionally, the first driving mechanism includes a first driving member and a second driving member. The above-mentioned controlling the mechanical leg to rotate relative to the fuselage by the first driving mechanism includes: driving the first leg mechanism and the second leg mechanism to rotate relative to the fuselage as a whole by the first driving member and the second driving member in cooperation.
[0065] The above-mentioned controlling the second leg mechanism to move linearly relative to the first leg mechanism by the first driving mechanism includes: driving the second leg mechanism to move linearly relative to the first leg mechanism along a first direction by the first driving member and the second driving member working together, and the first direction is the extension direction of the first leg mechanism.
[0066] Specifically, the first driving member and the second driving member can cooperate to drive the first leg mechanism and the second leg mechanism as a whole to rotate relative to the fuselage, thereby realizing the first driving mechanism to control the mechanical leg to rotate relative to the fuselage. In addition, the first driving member and the second driving member can cooperate to drive the second leg mechanism to move linearly along the first direction relative to the first leg mechanism, thereby realizing the first driving mechanism to control the second leg mechanism to move linearly relative to the first leg mechanism. The first direction is the extension direction of the first leg mechanism.
[0067] Optionally, the first driving member includes a first flexible transmission member, a first transmission wheel and a second transmission wheel, the first transmission wheel and the second transmission wheel are used to be rotatably connected to the first leg mechanism and are spaced apart along the first direction, the first flexible transmission member is connected between the first transmission wheel and the second transmission wheel and is used to be connected to the second leg mechanism; the second driving member includes a second flexible transmission member, a third transmission wheel and a fourth transmission wheel, the third transmission wheel and the fourth transmission wheel are used to be rotatably connected to the first leg mechanism and are spaced apart along the first direction, the second flexible transmission member is connected between the third transmission wheel and the fourth transmission wheel and is used to be connected to the second leg mechanism. The above method includes: by controlling the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and at the same speed, the second leg mechanism is driven to move linearly along the first direction relative to the first leg mechanism; or, by controlling the first flexible transmission member and the second flexible transmission member to rotate in the same direction and at the same speed, the first leg mechanism and the second leg mechanism are rotated as a whole relative to the fuselage.
[0068] Optionally, the first driving component also includes a first motor, and the second driving component includes a second motor. The first motor and the second motor are used to be connected to the fuselage, and the first motor and the second motor are coaxially arranged. The first motor is used to drive the first flexible transmission member to rotate, and the second motor is used to drive the second flexible transmission member to rotate; the method includes: controlling the first motor and the second motor to rotate in opposite directions and with the same torque, thereby controlling the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and at the same speed; or, controlling the first motor and the second motor to rotate in the same direction and with the same torque, thereby controlling the first flexible transmission member and the second flexible transmission member to rotate in the same direction and at the same speed.
[0069] On the basis of the above embodiments, the method also includes: by controlling the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and at different rotation speeds, thereby driving the second leg mechanism to move linearly along a first direction relative to the first leg mechanism, and also realizing the rotation of the first leg mechanism and the second leg mechanism as a whole relative to the fuselage; or, by controlling the first flexible transmission member and the second flexible transmission member to rotate in the same direction and at different rotation speeds, thereby driving the first leg mechanism and the second leg mechanism to rotate as a whole relative to the fuselage, and also realizing the second leg mechanism to move linearly along the first direction relative to the first leg mechanism.
[0070] Optionally, the first driving component also includes a first motor, the second driving component includes a second motor, the first motor and the second motor are used to be connected to the fuselage, and the first motor and the second motor are coaxially arranged, the first motor is used to drive the first flexible transmission member to rotate, and the second motor is used to drive the second flexible transmission member to rotate; the method includes: controlling the first motor and the second motor to rotate in opposite directions and with different torques, thereby driving the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and with different rotation speeds; or, controlling the first motor and the second motor to rotate in the same direction and with different torques, thereby driving the first flexible transmission member and the second flexible transmission member to rotate in the same direction and with different rotation speeds.
[0071] See also Fig.10 , Fig.10 1 is a flow chart of controlling a robot according to the leg length change speed and the rotation angle provided by an embodiment of the present application. Fig.10 As shown, the robot can also be controlled according to the leg length change speed and the rotation angle according to steps S21 to S23.
[0072] Step S21: Acquire a first absolute position angle of the first motor and a second absolute position angle of the second motor.
[0073] Optionally, the robot also includes a first limiter and a second limiter, the first limiter is used to limit the rotation angle between the mechanical leg and the body, and the second limiter is used to limit the extension and retraction length of the mechanical leg; before obtaining the first absolute position angle of the first motor and the second absolute position angle of the second motor, the method also includes: controlling the first motor and the second motor to drive the mechanical leg to rotate relative to the body and the extension and retraction movement of the mechanical leg, and when abutting against the first limiter and the second limiter, determining that the first motor and the second motor reach an initial position, and the angle corresponding to the initial position is the initial angle of the first motor and the second motor.
[0074] Among them, the first absolute position angle and the second absolute position angle are the angles of the first motor and the second motor relative to the initial position; the initial position is the position of the first motor and the second motor when the rotation of the mechanical leg and the body abuts against the first limit piece when the robot is powered on, and the telescopic ground of the mechanical leg abuts against the second limit piece.
[0075] Specifically, when the robot is powered on, the first motor and the second motor can be controlled to drive the mechanical legs to rotate relative to the body (gradually reduce the angle between the body and the mechanical legs) and telescopic movement (gradually shorten the length of the mechanical legs). In this process, the mechanical legs will move to the first limiter and the second limiter, and the movement of the mechanical legs will be restricted when touching the first limiter and the second limiter. Because when the angle between the body and the mechanical legs and the length of the mechanical legs reach the corresponding limits, the motor may be blocked, that is, it stops moving when it cannot continue to rotate. Therefore, by monitoring the current when the motor is blocked, it can be determined whether the angle between the body and the mechanical legs and the length of the mechanical legs have reached the corresponding limits. And when the angle between the body and the mechanical legs and the length of the mechanical legs have reached the corresponding limits, it is determined that the first motor and the second motor have reached the initial position, and the angle corresponding to the initial position is determined as the initial angle of the first motor and the second motor.
[0076] It should be noted that the present application does not limit the method for obtaining the first absolute position angle and the second absolute position angle. For example, they can be detected by an external position sensor, or they can be obtained by encoders built into the first motor and the second motor.
[0077] It is understandable that the angles of the first motor and the second motor at the initial position, that is, the first absolute position angle and the second absolute position angle, can be directly output through the detection of the position sensor. Therefore, obtaining the first position angle and the second position angle based on the external position sensor has a certain real-time performance, and the position sensor has a strong anti-interference ability, so the first position angle and the second position angle outputted by it are more reliable.
[0078] Optionally, based on the above embodiment, obtaining the first absolute position angle of the first motor and the second absolute position angle of the second motor includes: obtaining the first current angle of the first motor and the second current angle of the second motor; determining the first absolute position angle of the first motor and the second absolute position angle of the second motor based on the first current angle, the second current angle and the initial angle.
[0079] Specifically, the first current angle of the first motor can be subtracted from its corresponding initial angle to obtain the first absolute position angle of the first motor; similarly, the second current angle of the second motor can be subtracted from its corresponding initial angle to obtain the second absolute position angle of the second motor. Thus, the second absolute position angle and the second absolute position angle can be determined.
[0080] The first current angle and the second current angle can be read by the encoder built into the first motor or the second motor, and then the first absolute position angle and the second absolute position angle can be calculated. Since an additional external absolute position sensor is omitted, the system cost is reduced, and the need for sensor maintenance and calibration is reduced.
[0081] In the embodiment of the present application, the first absolute position angle and the second absolute position angle can be obtained to determine the leg length of the mechanical leg and the rotation angle between the mechanical leg and the body, and then used for the movement of the mechanical leg.
[0082] Step S22: determining the length of the mechanical leg according to the first absolute position angle, the second absolute position angle and the radius of the transmission wheel; and / or determining the rotation angle between the mechanical leg and the fuselage according to the first absolute position angle, the second absolute position angle and the radius of the transmission wheel; wherein the transmission wheel is any one of the first transmission wheel, the second transmission wheel, the third transmission wheel and the fourth transmission wheel.
[0083] Step S23: Determine the leg length change speed and the rotation angle change speed of the mechanical leg according to the leg length and the rotation angle respectively, so as to control the linear motion of the mechanical leg according to the leg length change speed, and control the rotation of the mechanical leg relative to the fuselage according to the rotation angle change speed.
[0084] Specifically, the length of the mechanical leg and the rotation angle between the mechanical leg and the fuselage can be determined by the following formula:
[0085]
[0086]
[0087] Among them, L is the length of the mechanical leg; Phi is the rotation angle between the mechanical leg and the fuselage; theta1 is the first absolute position angle; theta2 is the second absolute position angle; R is the radius of the transmission wheel.
[0088] Furthermore, after obtaining the leg length and the rotation angle, they can be differentiated to determine the leg length change speed and the rotation angle change speed of the mechanical leg. Thus, according to the preset control method, the linear motion of the mechanical leg can be controlled according to the leg length change speed, and the rotation of the mechanical leg relative to the fuselage can be controlled according to the rotation angle change speed, so that the mechanical leg reaches the corresponding preset target value.
[0089] It should be noted that the preset target value is not limited in this application and can be set according to actual needs. In addition, the preset control method can be a closed-loop control method, an adaptive control method, etc. This application takes the closed-loop control method as an example for explanation.
[0090] The closed-loop control method is a control method that measures the system output and compares it with the expected output, and then adjusts the system to make it close to the expected value. It usually includes three main components: sensors, controllers, and actuators. Among them, the sensor is used to measure the output or feedback signal of the system; the controller is used to generate the corresponding control signal based on the information fed back by the sensor and the set expected value. The actuator is used to receive the signal from the controller and adjust the system, such as driving the motor, performing actions, or adjusting parameters, so that the system reaches the desired state.
[0091] In the embodiment of the present application, the movement of the robot can be continuously adjusted through a closed-loop control algorithm so that it can remain in a desired state in the presence of external disturbances or changes.
[0092] See also Fig.11 , Fig.11 1 is a schematic diagram of a flow chart of controlling the steering of a robot provided in an embodiment of the present application. Fig.11 As shown, the robot control method provided by the present application further includes steps S31 to S32 to realize the control of the robot turning. The posture information may also include yaw angle information.
[0093] Step S31: Obtain the target yaw angle of the robot, and determine the current yaw angle of the robot.
[0094] Specifically, the robot's angular velocity information and acceleration information can be obtained through attitude sensors (such as gyroscopes, accelerometers, visual sensors, etc.) installed on the body, and then the angular velocity information and acceleration information of the robot are fused through a preset algorithm to obtain the robot's current yaw angle.
[0095] In addition, the present application does not limit the target yaw angle of the robot, which can be set according to actual needs.
[0096] Step S32: Control the foot steering of the robot according to the current yaw angle and the target yaw angle, so that the robot runs according to the target yaw angle.
[0097] After obtaining the current yaw angle and the target yaw angle, the robot's foot steering can be controlled based on the target yaw angle and the robot's current yaw angle through control methods such as closed-loop control algorithms, so that the robot can run according to the target yaw angle.
[0098] In an embodiment of the present application, the target yaw angle of the robot can be obtained, and the current yaw angle of the robot can be determined, and then the foot steering of the robot can be controlled based on the previous yaw angle and the target yaw angle, so that the robot can run according to the target yaw angle.
[0099] Optionally, the foot includes a wheel, the second driving mechanism includes a third motor, and the third motor is used to drive the wheel to rotate; the foot steering of the robot is controlled according to the current yaw angle and the target yaw angle, including: determining the torque used to drive the third motors on the two mechanical legs according to the current yaw angle and the target yaw angle; and controlling the rotation of the third motors on the two mechanical legs by utilizing the motor differential according to the torque of the third motor, so as to enable the robot to operate according to the target yaw angle.
[0100] Specifically, the torque required for the third motor to drive the two mechanical legs to turn can be obtained based on the current yaw angle and the target yaw angle through a closed-loop control method. Furthermore, the third motors on the two mechanical legs can be controlled to rotate according to the torque of the third motor and the motor differential can be used to achieve precise adjustment of the robot's yaw angle so that it can run according to the target yaw angle to achieve the purpose of controlling the robot's steering.
[0101] In an embodiment of the present application, the robot's foot steering can be controlled based on the current yaw angle and the target yaw angle, so that it moves in the direction of the target yaw angle, which helps the robot move in the desired direction in applications such as navigation, path planning or obstacle avoidance.
[0102] See also Fig.12 , Fig.12 FIG. 1 is a flow chart of controlling a robot according to an inverted pendulum model provided in an embodiment of the present application. Fig.12 As shown, the robot control method provided in the present application also includes steps S41 to S42 to control the robot according to the inverted pendulum model.
[0103] Step S41: Obtain the leg length of the mechanical leg, the foot mass and foot moment of inertia of the foot, the leg mass and leg moment of inertia of the mechanical leg, the body mass and body moment of inertia of the fuselage, and establish an inverted pendulum model of the robot.
[0104] Step S42: Control the robot to maintain balance on the support surface according to the inverted pendulum model.
[0105] It should be noted that the inverted pendulum model is a mathematical model that describes the dynamic behavior of an inverted pendulum system. It is usually used to study and design control systems or devices to enable the inverted pendulum to maintain balance or perform specific movements. The inverted pendulum model involves factors such as the mass, length, friction of the pendulum rod, and the external control force to accurately describe the system's motion equations. The inverted pendulum model has a wide range of applications in fields such as control theory and robotics.
[0106] Specifically, since the length of the robot's mechanical legs, the foot mass and foot moment of inertia, the leg mass and leg moment of inertia, and the body mass and body moment of inertia directly affect the robot's motion and stability, an inverted pendulum model of the robot can be established based on the above parameters using Newton-Euler and other dynamic principles to control the balance or stability of the robot.
[0107] Furthermore, after obtaining the inverted pendulum model of the robot, an appropriate control strategy, such as closed-loop control, linear control, etc., can be used to control the posture of the robot so that the robot can maintain balance on the support surface. For example, sensor information (such as a gyroscope, accelerometer, etc.) can be used to measure the current robot posture information, and then the robot can be adjusted according to the desired posture.
[0108] Optionally, the angle and angular velocity information of the third motor can be obtained to obtain the acceleration information of the robot, and then the data fusion can be performed to obtain the forward displacement and forward speed of the robot. Therefore, according to the inverted pendulum model of the robot, the full-state controller can be used to perform full-state control on the rotation angle between the mechanical leg and the fuselage and the corresponding angular velocity, pitch angle and pitch angular velocity, forward displacement, forward speed, etc., and output the torque required by the first motor and the second motor to drive the mechanical leg to move, thereby achieving the purpose of making the robot stand and balance. In addition, the robot can also be controlled to move forward and backward by giving the robot a preset forward speed.
[0109] Optionally, the robot's inverted pendulum model can be used to obtain the torque required for the third motor to drive the robot to turn by comparing the robot's yaw angle with a preset target yaw angle, using a traditional closed-loop control method. The third motor on the two mechanical legs can then be controlled to rotate according to the torque of the third motor by using the motor differential, so that the robot can run according to the target yaw angle and the purpose of controlling the robot's turning can be achieved.
[0110] Optionally, based on the inverted pendulum model of the robot, a full-state controller can be used to perform full-state control on the pitch angle, pitch angular velocity, etc. of the robot, output the torque required by the first motor and the second motor, and thereby achieve the purpose of keeping the pitch angle of the robot's upper body horizontal.
[0111] Optionally, based on the inverted pendulum model of the robot, a full-state controller can be used to control the roll angle and the preset target roll angle, and the torque required for the first motor and the second motor to control the left and right tilt of the body can be output, thereby achieving the purpose of controlling the left and right tilt of the robot body.
[0112] In an embodiment of the present application, an inverted pendulum model of the robot can be established, and the balance control, steering control and roll control can be decoupled according to the robot's posture information. The robot can be controlled separately according to different control variables and parameters, thereby reducing the complexity and computational complexity of the robot control.
[0113] Optionally, the robot includes one or more of a first control mode, a second control mode and a third control mode, and the first control mode, the second control mode and the third control mode can be controlled independently. Among them, the first control mode is realized by controlling the mechanical leg to rotate relative to the body according to the posture information; the second control mode is realized by controlling the second leg mechanism to move linearly relative to the first leg mechanism according to the posture information; and the third control mode is realized by controlling the foot movement according to the posture information.
[0114] In the embodiment of the present application, different control modes of the robot can be decoupled to control the robot separately according to actual needs, thereby helping to improve the accuracy and efficiency of robot control and reducing model complexity and computational burden.
[0115] Optionally, based on the above embodiment, the first control mode, the second control mode and the third control mode are all linear controls.
[0116] In the embodiment of the present application, the robot can be linearly controlled, thereby making the control model of the robot relatively simple, easy to analyze and design, and improving the stability and accuracy of the robot, so that the robot can perform tasks according to the preset control mode and quickly respond to changes in the external environment.
[0117] Exemplarily, the above method and apparatus may be implemented in the form of a computer program. The computer program may be implemented in the form of a computer program. Fig.13 Run on the robot shown.
[0118] See also Fig.13 , Fig.13 is a schematic diagram of a robot provided in an embodiment of the present application. Fig.13 As shown, the robot 1000 includes a processor 401, a memory 402 and a network interface connected via a system bus, wherein the memory 402 may include a volatile storage medium, a non-volatile storage medium and an internal memory.
[0119] The non-volatile storage medium can store an operating system and a computer program. The computer program includes program instructions, and when the program instructions are executed, the processor 401 can execute any risk control method based on logistics data.
[0120] The processor 401 is used to provide computing and control capabilities to support the operation of the entire robot 1000.
[0121] The internal memory provides an environment for the operation of the computer program in the non-volatile storage medium. When the computer program is executed by the processor, the processor can execute any risk control method based on logistics data.
[0122] The network interface is used for network communication, such as sending assigned tasks, etc. Those skilled in the art can understand that the structure of the robot 1000 is only a block diagram of a part of the structure related to the solution of the present application, and does not constitute a limitation on the robot 1000 to which the solution of the present application is applied. The specific robot 1000 may include more or fewer components than those shown in the figure, or combine certain components, or have a different arrangement of components.
[0123] It should be understood that the processor 401 may be a central processing unit (CPU), and the processor 401 may also be other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. Among them, the general-purpose processor may be a microprocessor or the processor may also be any conventional processor, etc.
[0124] Among them, in some embodiments, the processor 401 is used to run a computer program stored in a memory to implement the following steps: obtaining posture information of the robot, the posture information including at least one of pitch angle information and roll angle information; according to the posture information, controlling the mechanical leg to rotate relative to the fuselage through the first drive mechanism; and / or, according to the posture information, controlling the second leg mechanism to move in a straight line relative to the first leg mechanism through the first drive mechanism; so as to change the center of gravity of the robot, thereby allowing the robot to maintain balance on the support surface where the robot is located.
[0125] In some embodiments, the processor 401 is also used to obtain the target yaw angle of the robot and determine the current yaw angle of the robot; control the foot steering of the robot according to the current yaw angle and the target yaw angle, so that the robot runs according to the target yaw angle.
[0126] In some embodiments, the robot includes one or more of a first control mode, a second control mode, and a third control mode, and the processor 401 is also used to independently control the first control mode, the second control mode, and the third control mode; wherein the first control mode is achieved by controlling the mechanical leg to rotate relative to the body according to the posture information; the second control mode is achieved by controlling the second leg mechanism to move in a straight line relative to the first leg mechanism according to the posture information; and the third control mode is achieved by controlling the foot movement according to the posture information.
[0127] In some implementations, the processor 401 is further configured to linearly control the first control mode, the second control mode, and the third control mode.
[0128] In some embodiments, the processor 401 is also used to drive the first leg mechanism and the second leg mechanism to rotate as a whole relative to the fuselage through the cooperation of the first driving member and the second driving member; and drive the second leg mechanism to move linearly along a first direction relative to the first leg mechanism through the cooperation of the first driving member and the second driving member, and the first direction is the extension direction of the first leg mechanism.
[0129] In some embodiments, the processor 401 is also used to drive the second leg mechanism to move linearly along the first direction relative to the first leg mechanism by controlling the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and at the same speed; or, by controlling the first flexible transmission member and the second flexible transmission member to rotate in the same direction and at the same speed, the first leg mechanism and the second leg mechanism can rotate as a whole relative to the fuselage.
[0130] In some embodiments, the processor 401 is also used to control the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and at different rotation speeds, thereby driving the second leg mechanism to move linearly along the first direction relative to the first leg mechanism, and also realize the first leg mechanism and the second leg mechanism to rotate as a whole relative to the fuselage; or, control the first flexible transmission member and the second flexible transmission member to rotate in the same direction and at different rotation speeds, thereby driving the first leg mechanism and the second leg mechanism to rotate as a whole relative to the fuselage, and also realize the second leg mechanism to move linearly along the first direction relative to the first leg mechanism.
[0131] In some embodiments, the processor 401 is also used to control the first motor and the second motor to rotate in opposite directions and with the same torque, thereby controlling the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and at the same speed; or, controlling the first motor and the second motor to rotate in the same direction and with the same torque, thereby controlling the first flexible transmission member and the second flexible transmission member to rotate in the same direction and at the same speed.
[0132] In some embodiments, the processor 401 is also used to control the first motor and the second motor to rotate in opposite directions and with different torques, thereby driving the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and with different rotation speeds; or, control the first motor and the second motor to rotate in the same direction and with different torques, thereby driving the first flexible transmission member and the second flexible transmission member to rotate in the same direction and with different rotation speeds.
[0133] In some embodiments, the processor 401 is also used to obtain a first absolute position angle of the first motor and a second absolute position angle of the second motor; determine the leg length of the mechanical leg according to the first absolute position angle, the second absolute position angle and the radius of the transmission wheel; and / or determine the rotation angle between the mechanical leg and the fuselage according to the first absolute position angle, the second absolute position angle and the radius of the transmission wheel; wherein the transmission wheel is any one of the first transmission wheel, the second transmission wheel, the third transmission wheel and the fourth transmission wheel; according to the leg length and the rotation angle, determine the leg length change speed and the rotation angle change speed of the mechanical leg respectively, so as to control the linear motion of the mechanical leg according to the leg length change speed, and control the rotation of the mechanical leg relative to the fuselage according to the rotation angle change speed.
[0134] In some embodiments, the processor 401 is also used to control the first motor and the second motor to drive the mechanical leg to rotate relative to the fuselage and to extend and retract the mechanical leg, and when abutting against the first limit member and the second limit member, determine that the first motor and the second motor reach an initial position, and the angle corresponding to the initial position is the initial angle of the first motor and the second motor; obtain the first current angle of the first motor and the second current angle of the second motor; and determine the first absolute position angle of the first motor and the second absolute position angle of the second motor based on the first current angle, the second current angle and the initial angle.
[0135] In some embodiments, the processor 401 is also used to obtain the leg length of the mechanical leg, the foot mass and foot moment of inertia of the foot, the leg mass and leg moment of inertia of the mechanical leg, the body mass and body moment of inertia of the fuselage, and establish an inverted pendulum model of the robot; and control the robot to maintain balance on the support surface according to the inverted pendulum model.
[0136] In some embodiments, the processor 401 is further used to determine the torque for driving the third motor on the two mechanical legs based on the current yaw angle and the target yaw angle; and to control the rotation of the third motor on the two mechanical legs by utilizing the motor differential according to the torque of the third motor, so as to enable the robot to operate according to the target yaw angle.
[0137] An embodiment of the present application also provides a computer-readable storage medium, on which a computer program is stored. The computer program includes program instructions, and when the program instructions are executed, any one of the robot-based control methods provided in the embodiments of the present application is implemented.
[0138] The computer-readable storage medium may be an internal storage unit of the robot 1000 described in the foregoing embodiment, such as a hard disk or memory of the robot 1000. The computer-readable storage medium may also be an external storage device of the robot 1000, such as a plug-in hard disk, a smart memory card (SmartMedia Card, SMC), a secure digital (Secure Digital, SD) card, a flash card (Flash Card), etc., equipped on the robot 1000.
[0139] Furthermore, the computer-readable storage medium may mainly include a program storage area and a data storage area, wherein the program storage area may store an operating system, an application program required for at least one function, and the like.
[0140] The above is only a specific implementation of the present application, but the protection scope of the present application is not limited thereto. Any technician familiar with the technical field can easily think of various equivalent modifications or replacements within the technical scope disclosed in the present application, and these modifications or replacements should be included in the protection scope of the present application. Therefore, the protection scope of the present application shall be based on the protection scope of the claims.
Claims
1. A robot control method, characterized in that: The robot comprises a body, a posture sensor arranged on the body, at least two mechanical legs and at least two first driving mechanisms, wherein the mechanical legs are rotatably connected to the body, the mechanical legs comprise a first leg mechanism and a second leg mechanism, and the first driving mechanism is configured to be able to drive the second leg mechanism to perform linear motion relative to the first leg mechanism, and to drive the mechanical legs to rotate relative to the body; The control method comprises: Acquire posture information of the robot, wherein the posture information includes at least one of pitch angle information and roll angle information; According to the posture information, the first driving mechanism is used to control the mechanical leg to rotate relative to the body; and / or, according to the posture information, the first driving mechanism is used to control the second leg mechanism to move linearly relative to the first leg mechanism; so as to change the center of gravity of the robot, thereby allowing the robot to maintain balance on the supporting surface where the robot is located.
2. The method according to claim 1, characterized in that The robot further comprises a foot and a second driving mechanism, wherein the foot is connected to the second leg mechanism for supporting the robot when the robot is walking or standing, and the second driving mechanism is configured to be able to drive the foot to move; The attitude information may further include yaw angle information; the method further includes: Acquiring a target yaw angle of the robot, and determining a current yaw angle of the robot; The foot steering of the robot is controlled according to the current yaw angle and the target yaw angle, so that the robot runs according to the target yaw angle.
3. The method according to claim 2, characterized in that The robot includes one or more of a first control mode, a second control mode and a third control mode, wherein the first control mode, the second control mode and the third control mode can be controlled independently; Among them, the first control mode is achieved by controlling the mechanical leg to rotate relative to the fuselage according to the posture information; the second control mode is achieved by controlling the second leg mechanism to move linearly relative to the first leg mechanism according to the posture information; and the third control mode is achieved by controlling the foot movement according to the posture information.
4. The method according to claim 3, characterized in that The first control mode, the second control mode and the third control mode are all linear controls.
5. The method according to any one of claims 1 to 4, characterized in that: The first drive mechanism includes a first drive member and a second drive member; The controlling the mechanical leg to rotate relative to the body by the first driving mechanism comprises: driving the first leg mechanism and the second leg mechanism to rotate relative to the body as a whole by the first driving member and the second driving member in cooperation with each other; Controlling the second leg mechanism to move linearly relative to the first leg mechanism through the first driving mechanism includes: driving the second leg mechanism to move linearly relative to the first leg mechanism along a first direction through the cooperation of the first driving member and the second driving member, and the first direction is the extension direction of the first leg mechanism.
6. The method according to claim 5, characterized in that The first driving member includes a first flexible transmission member, a first transmission wheel and a second transmission wheel, the first transmission wheel and the second transmission wheel are used to be rotatably connected to the first leg mechanism and are spaced apart along the first direction, the first flexible transmission member is connected between the first transmission wheel and the second transmission wheel and is used to be connected to the second leg mechanism; the second driving member includes a second flexible transmission member, a third transmission wheel and a fourth transmission wheel, the third transmission wheel and the fourth transmission wheel are used to be rotatably connected to the first leg mechanism and are spaced apart along the first direction, the second flexible transmission member is connected between the third transmission wheel and the fourth transmission wheel and is used to be connected to the second leg mechanism; the method includes: By controlling the first flexible transmission member and the second flexible transmission member to rotate in opposite directions with the same rotation speed, the second leg mechanism is driven to move linearly along the first direction relative to the first leg mechanism; or, By controlling the first flexible transmission member and the second flexible transmission member to rotate in the same direction and at the same speed, the first leg mechanism and the second leg mechanism can be rotated as a whole relative to the fuselage.
7. The method according to claim 6, characterized in that The method further comprises: By controlling the first flexible transmission member and the second flexible transmission member to rotate in opposite directions with different rotation speeds, the second leg mechanism is driven to move linearly along the first direction relative to the first leg mechanism, and the first leg mechanism and the second leg mechanism are rotated as a whole relative to the fuselage; or, By controlling the first flexible transmission member and the second flexible transmission member to rotate in the same direction but at different rotation speeds, the first leg mechanism and the second leg mechanism are driven to rotate as a whole relative to the fuselage, and the second leg mechanism is also enabled to move linearly along the first direction relative to the first leg mechanism.
8. The method according to claim 6, characterized in that The first driving member further comprises a first motor, the second driving member comprises a second motor, the first motor and the second motor are used to be connected to the body, and the first motor and the second motor are coaxially arranged, the first motor is used to drive the first flexible transmission member to rotate, and the second motor is used to drive the second flexible transmission member to rotate; the method comprises: Control the first motor and the second motor to rotate in opposite directions and with the same torque, thereby controlling the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and with the same speed; or, The first motor and the second motor are controlled to rotate in the same direction and with the same torque, thereby controlling the first flexible transmission member and the second flexible transmission member to rotate in the same direction and at the same speed.
9. The method according to claim 7, characterized in that: The first driving member further comprises a first motor, the second driving member comprises a second motor, the first motor and the second motor are used to be connected to the body, and the first motor and the second motor are coaxially arranged, the first motor is used to drive the first flexible transmission member to rotate, and the second motor is used to drive the second flexible transmission member to rotate; the method comprises: Control the first motor and the second motor to rotate in opposite directions and with different torques, thereby driving the first flexible transmission member and the second flexible transmission member to rotate in opposite directions and at different speeds; or, The first motor and the second motor are controlled to rotate in the same direction and with different torques, thereby driving the first flexible transmission member and the second flexible transmission member to rotate in the same direction and with different rotation speeds.
10. The method according to claim 8, characterized in that The method comprises: Acquire a first absolute position angle of the first motor and a second absolute position angle of the second motor; Determine the leg length of the mechanical leg according to the first absolute position angle, the second absolute position angle and the radius of the transmission wheel; and / or determine the rotation angle between the mechanical leg and the fuselage according to the first absolute position angle, the second absolute position angle and the radius of the transmission wheel; wherein the transmission wheel is any one of the first transmission wheel, the second transmission wheel, the third transmission wheel and the fourth transmission wheel; According to the leg length and the rotation angle, the leg length change speed and the rotation angle change speed of the mechanical leg are determined respectively, so as to control the linear motion of the mechanical leg according to the leg length change speed, and control the rotation of the mechanical leg relative to the fuselage according to the rotation angle change speed.
11. The method according to claim 10, characterized in that The robot further comprises a first limiter and a second limiter, wherein the first limiter is used to limit a rotation angle between the mechanical leg and the body, and the second limiter is used to limit a telescopic length of the mechanical leg; Before acquiring the first absolute position angle of the first motor and the second absolute position angle of the second motor, the method further includes: Control the first motor and the second motor to drive the mechanical leg to rotate relative to the body and to perform telescopic movement of the mechanical leg, and when the first motor and the second motor abut against the first limiter and the second limiter, determine that the first motor and the second motor reach an initial position, and the angle corresponding to the initial position is the initial angle of the first motor and the second motor; The method of obtaining the first absolute position angle of the first motor and the second absolute position angle of the second motor includes: obtaining the first current angle of the first motor and the second current angle of the second motor; and determining the first absolute position angle of the first motor and the second absolute position angle of the second motor according to the first current angle, the second current angle and the initial angle.
12. The method according to claim 2, characterized in that: The method further comprises: Acquire the leg length of the mechanical leg, the foot mass and foot moment of inertia of the foot, the leg mass and leg moment of inertia of the mechanical leg, the body mass and body moment of inertia of the fuselage, and establish an inverted pendulum model of the robot; The robot is controlled to maintain balance on the support surface according to the inverted pendulum model.
13. The method according to claim 2, characterized in that The foot includes wheels, and the second driving mechanism includes a third motor, and the third motor is used to drive the wheels to rotate; The controlling the foot steering of the robot according to the current yaw angle and the target yaw angle comprises: Determine a torque for driving the third motors on the two mechanical legs according to the current yaw angle and the target yaw angle; The third motors on the two mechanical legs are controlled to rotate by utilizing the motor differential according to the torque of the third motor, so that the robot can run according to the target yaw angle.
14. A robot, characterized in that: include: A memory and a processor; wherein the memory is connected to the processor for storing a program; the processor is used to implement the steps of the robot control method as described in claims 1-13 by running the program stored in the memory.
15. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the processor implements the steps of the robot control method according to claims 1-13.
