Parallel elastic driving joint based on foot robot and driving method of parallel elastic driving joint
Through the design of parallel elastic driving joints, the tension springs matched by pulleys and wire ropes offset the gravity torque in a standing posture, solving the problem of high energy consumption of foot robots and improving the robot's endurance and design efficiency.
Patent Information
- Application Number
- CN202411146163.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-20
- Publication Date
- 2024-11-12
AI Technical Summary
Foot robots consume more energy in a standing posture, which affects their battery life and practicality.
The parallel elastic driving joint is adopted, including a driving mechanism, pulley, wire rope and a stretching spring. Through the cooperation of pulley and wire rope, the tension spring is stretched in a standing posture to offset the gravity torque and reduce the energy consumption of the drive mechanism.
It effectively reduces the energy consumption of foot robots in standing posture, improves the design efficiency and flexibility of robot joints, and extends the battery life.
Smart Images

Figure CN118928587A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of robot legs and feet, and in particular to a parallel elastic drive joint based on a foot-type robot and a drive method thereof. Background Art
[0002] The human knee joint is the largest and most complex joint in the human body. It is mainly composed of bone tissues such as the femur, patella, tibia, meniscus, femoral cartilage, tibial cartilage, patellar cartilage, and other tissues surrounding the synovium, joint capsule, ligaments, muscles, etc. It is a typical rigid-flexible coupling system with tensile structural characteristics. The movement of the knee joint is mainly achieved by the combined action of the biceps femoris and the quadriceps femoris. The biceps femoris is located on the back of the thigh and the inside of the knee joint, and the quadriceps femoris is located on the front of the thigh and the outside of the knee joint. When the two contract, the torque directions generated on the knee joint are opposite, and the flexion and extension control of the knee joint is achieved through antagonism.
[0003] A significant disadvantage of legged robots compared to wheeled and tracked mobile robots is that they require additional energy when standing. Since the legs of legged robots generally adopt a multi-rod series configuration, when the robot stands, the joint angles of the robot need to remain unchanged, and the joint motors are still in operation to output sufficient torque to balance the robot's own weight. The resulting energy consumption has basically no positive significance for the robot's work. On the contrary, it will greatly affect the robot's endurance and reduce the practicality of the legged robot. How to reduce this part of the energy consumption problem and improve the economy and environmental protection of legged robots is also a problem that needs to be solved urgently.
[0004] Therefore, the present invention provides a parallel elastic drive joint based on a foot-type robot to reduce energy consumption. Summary of the invention
[0005] In view of the above analysis, the present invention aims to provide a parallel elastic drive joint based on a legged robot and a driving method thereof, so as to solve the problem that the existing legged robot consumes a lot of energy to maintain a standing posture.
[0006] The purpose of the present invention is mainly achieved through the following technical solutions:
[0007] A parallel elastic drive joint based on a foot-type robot, comprising: a drive mechanism, a pulley, a steel wire rope and a tension spring;
[0008] The driving mechanism is used to drive the calf frame to rotate relative to the thigh frame;
[0009] The pulley is rotatably mounted on the upper end of the calf frame, one end of the tension spring is fixedly connected to the middle of the thigh frame, the other end of the tension spring is connected to the steel wire rope, and the steel wire rope passes around the pulley and is connected to the calf frame.
[0010] Furthermore, when the knee joint angle between the thigh frame and the calf frame is 150°, the tension spring is in a natural state.
[0011] Furthermore, when the legged robot is in a standing posture, the knee joint angle between the thigh skeleton and the calf skeleton is 90°, and the angle between the calf skeleton and the ground is 45°.
[0012] Furthermore, when the legged robot is in a walking posture, the angle between the thigh skeleton and the calf skeleton is less than 150°, and the tension spring is stretched.
[0013] Furthermore, a limit buckle is installed on the thigh frame, and the limit buckle is used to limit the movement direction of the movable end of the steel wire rope; a fixing buckle is installed on the calf frame, and the fixing buckle is used to fix the other end of the steel wire rope on the calf frame.
[0014] Furthermore, the limiting buckle is arranged on an extension line of the axis of the tension spring.
[0015] Furthermore, the limiting buckle clamps the steel wire rope and positions it between the thigh frame and the limiting buckle, so that the portion of the steel wire rope between the limiting buckle and the tension spring can only undergo linear displacement.
[0016] Furthermore, a tension spring connecting shaft is fixedly installed on the thigh frame, and the end of the tension spring is connected to the tension spring connecting shaft.
[0017] A robot leg and foot based on parallel elastic drive joints comprises: the parallel elastic drive joints, a thigh frame and a shank frame; the thigh frame and the shank frame are hingedly connected via a knee joint axis.
[0018] A driving method for a parallel elastically driven joint of a foot-type robot, using the parallel elastically driven joint, the driving method comprises the following steps:
[0019] Step S1: the driving mechanism drives the calf frame to rotate relative to the thigh frame;
[0020] Step S2: when the knee joint angle between the thigh frame and the calf frame is 150°-α, the pulley rotates around the axis of the knee joint shaft;
[0021] When the pulley rotates, it can drive the steel wire rope to deform, and pull the extension spring through the steel wire rope to extend; when the extension spring extends, it can store elastic potential energy, and when the extension spring retracts, it can release elastic potential energy;
[0022] Step S3: When the knee joint angle between the thigh skeleton and the calf skeleton is 90°, the robot is in a standing posture, the tension spring is in a tensioned state, and the tension spring applies a reverse torque to the calf skeleton through the wire rope to offset the gravity torque.
[0023] The technical solution of the present invention can achieve at least one of the following effects:
[0024] 1. The parallel elastic drive joint of the present invention is applied to the field of legged robots. By stretching the spring and the drive mechanism to form a parallel elastic structure, the energy consumption of the robot in a standing posture is reduced, thereby achieving a more efficient and flexible robot joint design.
[0025] 2. The parallel elastic drive joint based on the foot-type robot of the present invention is achieved by installing a tension spring on the thigh frame, and the end of the tension spring is connected to the calf frame through a steel wire rope, and the steel wire rope passes around the pulley located at the upper end of the calf frame; when the calf frame and the thigh frame rotate relative to each other, the steel wire rope pulls the tension spring to cause elastic deformation. At this time, the steel wire rope and the tension spring play an effect similar to the quadriceps femoris of the knee joint, and jointly control the movement of the knee joint with the driving mechanism.
[0026] 3. The parallel elastic drive joint based on the leg-type robot of the present invention, when the leg-type robot is in a standing posture, the thigh skeleton and the calf skeleton maintain a 90° posture. At this time, the tension spring is in a stretched state, and its elastic force can provide a reverse torque to the knee joint of the leg-foot structure. The reverse torque can offset a part of the gravity torque to reduce the energy consumption required for the driving mechanism to maintain the standing posture of the robot's legs and feet.
[0027] In the present invention, the above-mentioned technical solutions can also be combined with each other to achieve more preferred combination solutions. Other features and advantages of the present invention will be described in the subsequent description, and some advantages can become obvious from the description, or can be understood by practicing the present invention. The purpose and other advantages of the present invention can be realized and obtained through the contents particularly pointed out in the description and the drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0028] The drawings are only for the purpose of illustrating particular embodiments and are not to be considered limiting of the present invention. Like reference symbols denote like components throughout the drawings.
[0029] Figure 1 Schematic diagram of the structure of the parallel elastic drive joint involved in Example 1 of the present invention;
[0030] Figure 2 Schematic diagram of the geometric position relationship of the parallel elastic drive joint of Example 1 of the present invention;
[0031] Figure 3 Schematic diagram of the geometric relationship of the lever arm length of the parallel elastic drive joint according to Example 1 of the present invention;
[0032] Figure 4 This is a schematic diagram of the leg driving structure of the robot leg and foot according to Embodiment 2 of the present invention;
[0033] Figure 5 This is a schematic structural diagram of a crank assembly of a robot leg according to Embodiment 2 of the present invention;
[0034] Figure 6 This is a schematic diagram of the structure of the robot legs and feet according to Example 2 of the present invention.
[0035] Reference numerals:
[0036] 1-leaf spring drive member; 2-rotating structural member; 3-motor shaft; 4-leaf spring pad; 5-joint motor; 6-first rotating shaft; 7-crank end cover; 8-first connecting member; 9-driving connecting rod; 10-second connecting member; 11-thigh skeleton; 12-tension spring connecting shaft; 13-knee joint shaft; 14-second joint shaft; 15-calf skeleton; 16-foot; 17-encoder shaft; 18-encoder connecting platform; 19-encoder; 20-pulley; 21-fixing buckle; 22-wire rope; 23-tension spring; 24-limiting buckle;
[0037] 101 - connecting plate; 102 - conical leaf spring; 201 - cam portion; 202 - rotating shaft hole; 203 - crank portion; 204 - hinge shaft hole. DETAILED DESCRIPTION
[0038] The preferred embodiments of the present invention will be described in detail below in conjunction with the accompanying drawings, wherein the accompanying drawings constitute a part of the present invention and are used together with the embodiments of the present invention to illustrate the principles of the present invention, but are not used to limit the scope of the present invention.
[0039] Example 1
[0040] A specific embodiment of the present invention discloses a parallel elastic drive joint based on a foot-type robot, such as Figure 1As shown, it includes: a driving mechanism, a thigh frame 11, a calf frame 15, a pulley 20, a steel wire rope 22 and a tension spring 23; the thigh frame 11 and the calf frame 15 are hingedly connected via a knee joint axis 13; the driving mechanism can drive the calf frame 15 to rotate relative to the thigh frame 11; one end of the tension spring 23 is fixedly connected to the middle part of the thigh frame 11, and the other end of the tension spring 23 is connected to the calf frame 15 via a steel wire rope 22; the pulley 20 is rotatably installed on the upper end of the calf frame 15, and the steel wire rope 22 passes around the pulley 15.
[0041] In this embodiment, when the knee joint angle between the thigh frame 11 and the calf frame 15 is 150°, the tension spring 23 is in a natural state.
[0042] In this embodiment, when the legged robot is in a standing posture, the knee joint angle between the thigh skeleton 11 and the shank skeleton 15 is 90°, and the angle between the shank skeleton 15 and the ground is 45°.
[0043] In this embodiment, when the legged robot is in a walking posture, the angle between the thigh skeleton 11 and the shank skeleton 15 is less than 150°, and the tension spring 23 is stretched.
[0044] Furthermore, if Figure 1 As shown, a limiting buckle 24 is installed on the thigh frame 11, and the limiting buckle 24 is used to limit the movement direction of the movable end of the steel wire rope 22; a fixing buckle 21 is installed on the calf frame 15, and the fixing buckle 21 is used to fix the other end of the steel wire rope 22 on the calf frame 15.
[0045] Furthermore, if Figure 1 As shown, the limiting buckle 24 is arranged on the extension line of the axis of the tension spring 23 .
[0046] Specifically, the limiting buckle 24 clamps the steel wire rope 22 and positions it between the thigh frame 11 and the limiting buckle 24, so that the portion of the steel wire rope 22 between the limiting buckle 24 and the tension spring 23 can only undergo linear displacement.
[0047] Specifically, a tension spring connecting shaft 12 is fixedly mounted on the thigh frame 11 , and an end of the tension spring 23 is connected to the tension spring connecting shaft 12 .
[0048] like Figure 1 As shown, an arc-shaped hook is provided at the end of the tension spring 23, and the arc-shaped hook is hooked on the tension spring connecting shaft 12. When the thigh frame 11 and the calf frame 15 rotate relative to each other, the arc-shaped hook of the tension spring 23 can rotate around the tension spring connecting shaft 12.
[0049] In this embodiment, the driving mechanism includes: a crank assembly, a joint motor 5 and a connecting rod assembly; wherein, the crank assembly is rotatably mounted on the thigh frame 11, and can rotate under the drive of the joint motor 5; the connecting rod assembly is rotatably connected between the crank assembly and the calf frame 15, and the connecting rod assembly, the thigh frame 11, the calf frame 15 and the crank assembly together form a four-bar linkage mechanism, and then when the joint motor 5 drives the crank assembly to rotate, the calf frame 15 can be driven to rotate relative to the thigh frame 11 through the connecting rod assembly.
[0050] In the parallel elastic drive joint of the foot-type robot of this embodiment, the joint motor 5 and the drive mechanism are arranged on the inner side of the knee joint of the mechanical leg, similar to the biceps femoris. The parallel elastic structure (pulley 20, tension spring 23 and wire rope 22) is arranged on the outer side of the knee joint, forming a structure similar to the quadriceps femoris, which is used to bear part of the gravitational torque generated by the robot's own weight. This embodiment simulates the principle of muscle contraction to generate tension, and designs a parallel elastic structure composed of pulley 20, tension spring 23 and wire rope 22 to provide the knee joint with a torque in the opposite direction of the gravitational torque, thereby reducing the output torque and power of the drive motor and improving the robot's endurance.
[0051] In this embodiment, the quadriceps femoris, the bionic object of the stretch spring 23, is not simply connected to the femur (thigh bone) and the tibia (shin bone). There is also a patella that forms a joint with the femur on the front side of the knee joint. The tendon of the quadriceps femoris crosses the patella from the outside and then connects to the tibia. Therefore, during the contraction of the quadriceps femoris, the patella supports the quadriceps femoris, which increases the force arm of the quadriceps femoris and further amplifies the supporting torque of the quadriceps femoris. Therefore, the parallel elastic drive joint of the present invention is provided with a pulley 20 as a supporting point on the outside of the knee joint axis 13 of the foot-type robot to simulate the supporting effect of the patella on the quadriceps femoris, so as to enhance the knee joint supporting torque generated by the stretch spring 23.
[0052] Example 2
[0053] A specific embodiment of the present invention provides a robot leg based on parallel elastic drive joints, such as Figure 4 As shown, it includes: the parallel elastic drive joint described in Example 1, the thigh frame 11 and the calf frame 15.
[0054] In this embodiment, the thigh frame 11 includes: a front thigh plate, a back thigh plate and an outer thigh wall plate; the front thigh plate and the back thigh plate are parallel to each other and are fixedly connected by the outer thigh wall plate.
[0055] In this embodiment, the calf skeleton 15 includes: a calf front side plate, a calf rear side plate and a calf outer side wall plate; the calf front side plate and the calf rear side plate are parallel to each other, and the two are connected as a whole through the calf outer side wall plate.
[0056] Further, the tension spring 23 and the steel wire rope 22 are both installed between the thigh front plate and the thigh back plate of the thigh frame 11. The pulley 20 and the fixing buckle 21 are installed between the calf front plate and the calf back plate of the calf frame 15.
[0057] Furthermore, if Figure 5 As shown, the crank assembly includes: a leaf spring driving component 1 and a rotating structural component 2; wherein, the rotating structural component 2 is rotatably installed on the end of the thigh frame 11, and the rotating structural component 2 and the leaf spring driving component 1 are engaged with each other, and the leaf spring driving component 1 can rotate under the drive of the joint motor 5, and at the same time, the leaf spring driving component 1 can drive the rotating structural component 2 to rotate relative to the thigh frame 11.
[0058] Specifically, the leaf spring drive 1 includes: a connecting plate 101 and a conical leaf spring 102; two conical leaf springs 102 are arranged in parallel, and the two conical leaf springs 102 are an integral structure with the connecting plate 101. Furthermore, the conical leaf spring 102 is a variable cross-section structure with increasing thickness from the end to the root (the end connected to the connecting plate). The cam portion 203 of this embodiment can adjust the contact point with the conical leaf spring 102 according to the change of the rotation angle, so that the rotating structural member 2 can be used as an adjustment part to change the access length of the conical leaf spring 102 through its rotation, and then by designing the conical leaf spring 102 as a variable cross-section thickness structure, the overall stiffness of the crank assembly can be adjusted.
[0059] Furthermore, the leaf spring driving component 1 is fixedly mounted on the leaf spring pad 4, the leaf spring pad 4 is rotatably mounted on the thigh frame 11, and the leaf spring pad 4 is fixedly connected to the motor shaft 3 of the joint motor 5, so that the joint motor 5 can drive the leaf spring pad 4 and the leaf spring driving component 1 to rotate.
[0060] Specifically, the rotating structure 2 includes: a cam portion 201 and a crank portion 203, wherein the cam portion 201 and the crank portion 203 are an integral structure; a rotating shaft hole 202 is provided between the cam portion 201 and the crank portion 203, wherein a first rotating shaft 6 is installed in the rotating shaft hole 202, and the rotating structure 2 is rotationally connected to the thigh skeleton 11 through the first rotating shaft 6; a hinge shaft hole 204 is provided at the end of the crank portion 203, wherein a second rotating shaft is installed in the hinge shaft hole 204, and the crank portion 203 is rotationally connected to the connecting rod assembly through the second rotating shaft, and thus the rotating structure 12 can drive the connecting rod assembly to move when it rotates. Specifically, the rotating structure 2 is rotationally connected to the front side plate of the thigh through the first rotating shaft 6.
[0061] In this embodiment, cam structures are symmetrically arranged on both sides of the cam portion 201, and the edges of the cam structures are arc-shaped contour lines, such as Figure 5 shown.
[0062] Specifically, Figure 5 As shown, the width of the cam portion 201 gradually decreases from near to far from the crank portion 203. During implementation, the joint motor 5 drives the leaf spring driver 1 to rotate, and then the conical leaf spring 102 of the leaf spring driver 1 pushes the rotating structure 2 to rotate; when the conical leaf spring 102 pushes the rotating structure 2 to rotate, its side surface contacts the side surface of the cam portion 201; during rotation, the deformation of the conical leaf spring 101 is affected by the magnitude of the driving force. The greater the driving force, the greater the deformation of the conical leaf spring 101, and the closer the contact point between the side surface of the conical leaf spring 101 and the cam portion 201 is to the tip of the cam portion 201; when the driving force is smaller, the deformation of the conical leaf spring 101 is smaller, and the contact point between the conical leaf spring 101 and the cam portion 201 is closer to the root of the cam portion 201, that is, the connection between the cam portion 201 and the crank portion 203.
[0063] In this embodiment, the crank assembly composed of the leaf spring drive member 1 and the rotating structural member 2 is a variable stiffness structure with a stiffness selection mechanism of "high stiffness under high load and low stiffness under low load". The present invention realizes a series elastic drive based on the cam portion 201 and the conical leaf spring 102 with variable cross-section, and realizes automatic adjustment of stiffness, which significantly improves the compliance of the quadruped robot in complex environments.
[0064] In this embodiment, the connecting rod assembly includes: a first connecting member 8, a driving connecting rod 9 and a second connecting member 10; one end of the driving connecting rod 9 is hingedly connected to the end of the crank part 203 through the first connecting member 8, and the other end of the driving connecting rod 9 is fixedly connected to the second connecting member 10, and the second connecting member 10 and the calf frame 15 are hingedly connected through a second joint shaft 14; when the joint motor 5 drives the rotating structure 2 to rotate, the driving connecting rod 9 can drive the calf frame 15 to rotate relative to the thigh frame 11, thereby realizing the walking function of the robot leg and foot structure.
[0065] Specifically, the second rotating shaft is fixedly connected to the hinge shaft hole 204 through interference fit, the second rotating shaft is rotatably connected to the first connecting member 8 of the connecting rod assembly through a bearing, and a bearing end cover 7 is provided at the end of the first rotating shaft.
[0066] Furthermore, a foot portion 16 is provided at the end of the calf frame 15 .
[0067] Furthermore, if Figure 6As shown, an encoder shaft 17, an encoder connecting platform 18 and an encoder 19 are also installed on the thigh skeleton 11; the encoder shaft 17 is connected to the rotating structure 2, and the encoder 19 is installed on the encoder mounting platform 18, for monitoring the motion state of the rotating structure 2; and thus the motion state of the calf skeleton 15 relative to the thigh skeleton 11 can be displayed.
[0068] The parallel elastic drive joint of the present invention imitates the movement mechanism of the human knee joint. By adjusting the position of the pulley 20, the support point and the spring force arm can be adjusted, thereby optimizing the support and movement of the knee joint. The passive mechanism composed of the pulley 20, the wire rope 22 and the tension spring 23 is used to resist the gravitational torque generated by the robot's own gravity on the knee joint, thereby reducing the energy consumption of the knee joint motor 2 of the footed robot in a standing posture.
[0069] Example 3
[0070] A specific embodiment of the present invention is a driving method for a parallel elastic driving joint based on a legged robot according to embodiment 1, the driving method comprising the following steps:
[0071] Step S1: the driving mechanism drives the calf frame 15 to rotate relative to the thigh frame 11;
[0072] Step S2: when the knee joint angle between the thigh frame 11 and the calf frame 15 is 150°-α, the pulley 20 rotates around the axis of the knee joint shaft 13;
[0073] When the pulley 20 rotates, it can drive the steel wire rope 22 to deform, and pull the tension spring 23 to extend through the steel wire rope 22; when the tension spring 23 extends, it can store elastic potential energy, and when the tension spring 23 retracts, it can release elastic potential energy.
[0074] Step S3: When the knee joint angle between the thigh skeleton 11 and the calf skeleton 15 is 90°, the robot is in a standing posture, the tension spring 23 is in a tensioned state, and the tension spring 23 applies a reverse torque to the calf skeleton 15 through the wire rope 22 to offset the gravity torque.
[0075] In this embodiment, in step S1, the driving mode of the calf frame 11 rotating relative to the thigh frame 15 is:
[0076] Step S101: the joint motor 5 drives the leaf spring driving member 1 to rotate;
[0077] Step S102: the conical leaf spring 102 of the leaf spring driving member 1 is pressed into contact with the cam portion 201 of the rotating structure 2, and the leaf spring driving member 1 rotates and drives the rotating structure 2 to rotate through the conical leaf spring 102;
[0078] Step S103: the rotating structure 2 rotates, and the crank portion 203 thereof drives the calf frame 15 to rotate around the first joint axis 13 through the connecting rod assembly.
[0079] In this embodiment, in step S2, the stretch spring 23 stores elastic potential energy in the following manner:
[0080] Step S201: the angle between the thigh skeleton 11 and the calf skeleton 15 is the knee joint angle, the calf skeleton 15 rotates around the first joint axis 13, and when the calf skeleton 15 rotates through an angle α, the knee joint angle is 150°-α;
[0081] Step S202: when the calf frame 15 rotates toward the thigh frame 11 with the first joint axis 13 as the axis, the pulley 20 moves away from the thigh frame 11 with the first joint axis 13 as the axis;
[0082] Step S203: When the pulley 20 moves away from the thigh frame 11, it pulls the steel wire rope 22 to move, and the steel wire rope 22 drives the tension spring 23 to stretch and deform, thereby realizing the storage of elastic potential energy.
[0083] In step S3, when the legged robot is in a standing posture, the knee joint angle between the thigh skeleton 11 and the shank skeleton 15 is 90°, and the gravity of the legged robot itself generates a gravity moment M that further reduces the knee joint angle. G .
[0084] In step S3, the elastic force of the tension spring 23 offsets the gravity moment M G The method is:
[0085] Step S301: when the knee joint angle is 90°, the tension spring 23 is in a tension state, and the elastic force of the tension spring 23 is the product of its elastic coefficient and deformation;
[0086] Step S302: The tension spring 23 tightens the steel wire rope 22, and a part of the tension of the steel wire rope 22 is transmitted to the calf frame 15, and the other part is used as pressure applied to the pulley 20;
[0087] Step S303: The tension of the steel wire rope 22 on the calf frame 15 generates a torque M1 which promotes its reverse rotation, i.e., promotes the increase of the knee joint angle. At the same time, the pressure applied to the pulley 20 by the steel wire rope 22 is transmitted to the calf frame 15 through the pulley 20 to form a torque M2 which promotes its reverse rotation, i.e., promotes the increase of the knee joint angle. The reverse torque M generated by the tension spring 23 on the knee joint is the sum of M1 and M2.
[0088] In step S2, the distance between the pulley 20 and the axis of the knee joint axis 13 is the spring force arm dT transmitted by the pulley 20 to the calf skeleton 15 to form a torque to promote its reverse rotation; specifically, considering the movement characteristics of the knee joint during flexion and extension, the spring force arm is adjusted as the leg rotates by setting an outer support point B (pulley installation position), and the support point B and the tension spring are connected by a wire rope 22.
[0089] In this embodiment, the design method of the parallel elastic drive joint is:
[0090] Step S2031: Calculate the gravitational torque on the knee joint of the quadruped robot in a standing posture;
[0091] Step S2032: When the knee joint angle is 150°, the tension spring 25 is in the original length state, and the geometric relationship of the parallel elastic drive joint is established;
[0092] Step S2033: Calculate the corresponding relationship between the knee joint angle and the tension of the tension spring 23 according to the geometric relationship of the parallel elastic drive joint established in step S2032;
[0093] Step S2034: According to the spring tension F T and spring arm d T Calculate the reverse moment M T , according to the calculated reverse moment M T The spring force arm d is determined by the change curve of M2 and knee angle (150°-α) and the actual design requirements. T , and according to the spring force arm d T And the geometric relationship of the parallel elastic drive joint determines the installation position of the pulley 20.
[0094] It is worth noting that: in this embodiment, according to the spring force arm d T The magnitude of the reverse moment M is different. T (i.e. M2) is different from the change curve of the knee joint angle (150°-α). By changing the spring force arm d T The size of the reverse torque can be obtained, and then the spring arm d can be reasonably selected according to the actual application needs (considering the robot's own weight, the robot's standing time, the robot's operating mode, etc.). T size.
[0095] Specifically, in step S2031, the support force of each leg on the ground is its own weight divided by the number of legs. In the standing posture, the knee joint angle of the robot leg is 90°, and the angle between the shank axis and the ground is 45°. The gravitational moment generated by the robot mass on the knee joint is M G =F V l V cos45°;
[0096] Specifically, in step S2032: Figure 2 As shown, the geometric relationship of the parallel elastic drive joint is: connection point A is the position where one end of the tension spring 25 is connected to the thigh 3 (tension spring connecting shaft 12), and its horizontal distance from the knee joint axis 15 is a, and the vertical distance is b; the support point position in the original length state of the spring is support point B, and support point B is the position of the pulley 20; the distance between support point B and the knee joint axis 15 is c, and the angle between the line connecting the two and the axis of the calf skeleton 15 is β; the angle between the line connecting support point B and connection point A and the axis of the thigh skeleton 11 is γ; the distance between connection point A and support point B is s0. When the calf moves and the knee joint angle decreases by α, the position of the support point is B', and the distance from connection point A increases by Δs, which is the elongation of the tension spring. According to the geometric relationship of the parallel elastic drive joint, it can be obtained:
[0097]
[0098] Specifically, in step S2033: when the knee joint angle is 150°-α, according to Hooke's law, the tension of the extension spring 25 with a stiffness of k is F T =kΔs.
[0099] Specifically, in step S2034, Figure 3 is to calculate the spring force arm d T Required geometric relationship, d T is the length of the force arm to be calculated. According to the geometric relationship of the parallel elastic drive joint, we can get:
[0100]
[0101] According to the attached Figure 5 From the geometric relationship of the parallel elastic drive joint shown in the figure, the spring force arm can be obtained as: d T =csin∠OB'A=csin(150°-β-α-γ); then the reverse torque generated by the parallel elastic structure on the knee joint is: M T =F T d T =kcΔssin(150°-β-α-γ); Substituting the relevant parameters, we can get M T -α change curve.
[0102] The driving method of the parallel elastic drive joint of this embodiment stores gravitational potential energy through parallel springs and forms a supporting torque (reverse torque), thereby balancing part of the robot's weight to reduce the motor load and improve the robot's endurance.
[0103] The tension spring 25 of the present invention is arranged on the outside of the knee joint, simulating the action of the quadriceps femoris, providing a supporting torque to resist part of the gravity torque, thereby reducing the load of the motor 2. At the same time, considering the movement characteristics of the knee joint during flexion and extension, the outer pulley 20 is set as a support point to adjust the force arm of the tension spring 23 with the rotation of the leg, and the output of the supporting torque can be optimized by adjusting the installation position of the pulley 20.
[0104] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any changes or substitutions that can be easily conceived by any technician familiar with the technical field within the technical scope disclosed by the present invention should be covered within the protection scope of the present invention.
Claims
1. A parallel elastic drive joint based on a foot-type robot, characterized in that: include: A driving mechanism, a pulley (20), a steel wire rope (22) and a tension spring (23); The driving mechanism is used to drive the lower leg frame (15) of the foot-type robot to rotate relative to the upper leg frame (11); The pulley (20) is rotatably mounted on the upper end of the calf frame (15), one end of the tension spring (23) is fixedly connected to the middle of the thigh frame (11), the other end of the tension spring (23) is connected to the steel wire rope (22), and the steel wire rope (22) passes around the pulley (15) and is connected to the calf frame (15).
2. The parallel elastic drive joint based on a foot-type robot according to claim 1, characterized in that: When the knee joint angle between the thigh frame (11) and the calf frame (15) is 150°, the tension spring (23) is in a natural state.
3. The parallel elastic drive joint based on a foot-type robot according to claim 1, characterized in that: When the legged robot is in a standing posture, the knee joint angle between the thigh frame (11) and the shank frame (15) is 90°, and the angle between the shank frame (15) and the ground is 45°.
4. The parallel elastic drive joint based on a foot-type robot according to claim 1, characterized in that: When the foot-type robot is in a walking posture, the angle between the thigh frame (11) and the shank frame (15) is less than 150°, and the tension spring (23) is stretched.
5. The parallel elastic drive joint based on a foot-type robot according to any one of claims 1 to 4, characterized in that: The thigh frame (11) is provided with a limit buckle (24), and the limit buckle (24) is used to limit the movement direction of the movable end of the steel wire rope (22); the calf frame (15) is provided with a fixing buckle (21), and the fixing buckle (21) is used to fix the other end of the steel wire rope (22) to the calf frame (15).
6. The parallel elastic drive joint based on a foot-type robot according to claim 5, characterized in that: The limiting buckle (24) is arranged on the extension line of the axis of the tension spring (23).
7. The parallel elastic drive joint based on a foot-type robot according to claim 6, characterized in that: The limiting buckle (24) clamps the steel wire rope (22) and positions it between the thigh frame (11) and the limiting buckle (24), so that the portion of the steel wire rope (22) between the limiting buckle (24) and the tension spring (23) can only undergo linear displacement.
8. The parallel elastic drive joint based on a foot-type robot according to claim 7, characterized in that: A tension spring connecting shaft (12) is fixedly mounted on the thigh frame (11), and the end of the tension spring (23) is connected to the tension spring connecting shaft (12).
9. A robot leg based on parallel elastic drive joints, characterized in that: include: The parallel elastic drive joint, the thigh frame (11) and the calf frame (15) as described in any one of claims 1 to 8; the thigh frame (11) and the calf frame (15) are hingedly connected via a knee joint axis (13).
10. The driving method of the parallel elastic driving joint based on the legged robot according to any one of claims 1 to 8, characterized in that: The following steps are involved: Step S1: the driving mechanism drives the calf frame (15) to rotate relative to the thigh frame (11); Step S2: when the knee joint angle between the thigh frame (11) and the calf frame (15) is 150°-α, the pulley (20) rotates with the axis of the knee joint shaft (13) as the axis; When the pulley (20) rotates, it can drive the steel wire rope (22) to deform, and pull the tension spring (23) to extend through the steel wire rope (22); when the tension spring (23) extends, it can store elastic potential energy, and when the tension spring (23) retracts, it can release the elastic potential energy; Step S3: When the knee joint angle between the thigh frame (11) and the calf frame (15) is 90°, the robot is in a standing posture, the tension spring (23) is in a tensioned state, and the tension spring (23) applies a reverse torque to the calf frame (15) through the steel wire rope (22) to offset the gravity torque.
