A wire-driven decoupling robot arm

Through the symmetrical disc design and tension amplification mechanism, combined with the 3-UU parallel mechanism and the third tension amplification mechanism, the joint coupling problem in the arm of the linear-driven robot is solved, and independent movement of the shoulder joint, elbow joint and wrist joint is achieved, and the improvement of the shoulder joint, elbow joint and wrist joint is achieved. Stability and motion performance.

CN118559692BActive Publication Date: 2024-11-26SHANGHAI UNIV OF ENG SCI
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
CN202410816460.5
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-06-24
Publication Date
2024-11-26
Estimated Expiration
2044-06-24

AI Technical Summary

Technical Problem

The joint coupling problem in the arms of linearly driven robots leads to movement accuracy errors. The existing passive decoupling technology is immature and it is difficult to achieve independent joint movement.

Method used

A linear drive decoupling robot arm is designed, and a symmetric disc design is used to reduce the unevenness of cable tension, and amplify the elbow torque and stiffness without increasing joint mass and inertia. The 3-UU parallel mechanism and the third tension amplification mechanism enhance the freedom of movement and stiffness of the wrist joint, ensuring independent movement of the shoulder, elbow and wrist joints.

Benefits of technology

It effectively reduces the coupling problem during elbow joint movement, improves overall stability and load capacity, realizes independent movement of shoulder joints, elbow joints and wrist joints, and improves motor performance and overall strength.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118559692B_ABST
    Figure CN118559692B_ABST
Patent Text Reader

Abstract

The present invention discloses a wire-driven decoupling robot arm, comprising a shoulder joint, an upper arm, an elbow joint, a lower arm, a wrist joint and an end effector which are fixedly connected in sequence from the proximal end to the distal end. The elbow joint adopts a symmetrical disc design, which effectively reduces the lateral overturning caused by uneven cable tensioning force, improves the stability and load capacity during the movement, and uses a tension amplification mechanism to achieve the amplification of the torque and stiffness of the elbow joint without increasing the mass and inertia of the joint, thereby avoiding the coupling problem during the movement of the elbow joint. The pitch and yaw degrees of freedom of the wrist joint are realized by a two-degree-of-freedom 3-UU parallel mechanism, and the central axis roll degree of freedom is realized by a winch mechanism; the drive cable is combined with a flexible tension amplification mechanism to drive the wrist joint to achieve three-degree-of-freedom movement under the premise that the torque and stiffness of the wrist joint are improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of humanoid robots, and in particular to a line-driven decoupling robot arm. Background Art

[0002] With the development of science and technology, the application field of robots has gradually shifted from industry to people's daily life, and the requirements for robots have become more complex and diverse. This has led to the research and development of humanoid robots, and arms, as an important component of humanoid robots, have become a hot topic in current humanoid robot research.

[0003] Traditional robotic arms are usually driven directly by motors, which ensure high precision, high efficiency, and high stability. However, they are limited by their large volume and mass, large inertia during movement, and low self-weight ratio. Therefore, they are not suitable for the research and development of humanoid robot arms. Wire drives are widely used in humanoid robot arms due to their good flexibility, simple and light structure, low moment of inertia, and high load-to-weight ratio.

[0004] The coupling problem is a major difficulty in wire drive. In the process of cable winding to transmit power, the movement of the upper joint often causes the cable length on the next joint to change, resulting in errors in the motion accuracy of the next joint, and the upper and lower joints cannot achieve independent movement. In order to solve the coupling problem in wire drive, the existing technologies are developed from two aspects: active decoupling and passive decoupling. Active coupling is to compensate for the motion angles of adjacent joints through software control. When the upper joint moves, the next joint is reversed to compensate for the change in cable length. Passive coupling is to design a decoupling mechanism to keep the cable length unchanged or the same as much as possible to achieve independent movement of the joint, but the existing passive coupling technology is not mature. Summary of the invention

[0005] The technical problem to be solved by the present invention is to provide a wire-driven decoupling robot arm to solve the problem of joint coupling in the wire-driven process.

[0006] In order to solve the above technical problems, the technical solution adopted by the present invention is:

[0007] A wire-driven decoupling robot arm comprises a shoulder joint, an upper arm, an elbow joint, a lower arm, a wrist joint and an end effector which are fixedly connected in sequence from a proximal end to a distal end, and is characterized in that:

[0008] The shoulder joint comprises three shoulder motion modules, each of which has a rotating part with a single rotational degree of freedom, and the three shoulder motion modules are fixed in sequence so that the rotation axes of the three rotating parts are arranged perpendicular to each other;

[0009] The proximal end of the upper arm is fixed to the rotating part of the distal end of the shoulder joint, and the upper arm is provided with a transversely rotatable and fixed reel A, a reel B and a reel C, and each reel is connected to a first driving part that drives the reel to rotate;

[0010] The elbow joint comprises:

[0011] Two joint seats, the joint seats are U-shaped, and the opposite sides thereof are provided with vertically arranged rolling plates, the end surface of the rolling plate located on the opening side of the joint seat is a guide surface, the lower section of the guide surface is a vertical limiting section, and the upper section is a rolling section with a circular arc chamfer, the openings of the two joint seats are arranged opposite to each other, and the corresponding guide surfaces are in contact, a central axis is transversely fixed in the middle of the two joint seats, and a connecting rod is provided between the two central axes, and both ends of the connecting rod are rotatably fixed to the corresponding central axis;

[0012] The first tension amplification mechanism comprises a first drive cable and two first shafts symmetrically fixed in two joint seats, and a multi-groove first wire wheel is rotatably fixed on the two first shafts. The first drive cable is wound around the two first wire wheels for n1 turns and then led out toward the proximal end and wound forwardly on the winding shaft A;

[0013] The second tension amplification mechanism comprises a second drive cable and two second shafts symmetrically fixed in two joint seats, and a multi-groove second wire wheel is rotatably fixed on the two second shafts. The second drive cable is wound around the two second wire wheels for n2 turns and then led out toward the proximal end and reversely wound around the winding shaft A;

[0014] The wrist joint comprises:

[0015] An upper fixed frame, on which a driving shaft is rotatably fixed, two ends of the driving shaft pass through the upper fixed frame, a distal end of the driving shaft is fixed to an end effector, and the driving shaft is connected to a second driving part for driving the driving shaft to rotate;

[0016] A lower fixing frame fixed to a joint seat at the distal end of the elbow joint;

[0017] 4-UU parallel mechanism, fixed between the upper fixing frame and the lower fixing frame;

[0018] Four groups of third tension amplification mechanisms are evenly surrounded on the outside of the 3-UU parallel mechanism. The four groups of third tension amplification mechanisms are respectively placed in the front, rear, left and right of the 3-UU parallel mechanism. Each group of third tension amplification mechanisms includes an upper pulley group and a lower pulley group. The upper pulley group is fixed on the upper fixed frame, and the lower pulley group is fixed on the lower fixed frame. A third drive cable is wound between the upper pulley group and the lower pulley group. The free end of the third drive cable is led out toward the proximal end through a lead-out guide wheel.

[0019] Among them, the two third drive cables on the front and rear sides are led out and wound on the winding shaft B, one forward and one reversely, and the two third drive cables on the left and right sides are led out and wound on the winding shaft C, one forward and one reversely, and fixed.

[0020] A further technical solution is that the shoulder joint includes three shoulder motion modules, each of which includes:

[0021] Pedestal;

[0022] The driving wheel assembly includes a driving wire wheel and a driven wire wheel rotatably fixed on a base, wherein the driving wire wheel is connected to a third driving part for driving the driving wire wheel to rotate, and the driving wire wheel is the rotating part of the shoulder joint;

[0023] A fourth driving cable, one end of which is fixed to the driven wire wheel, and the other end of which is twisted around the driven wire wheel and the driving wire wheel and then fixed to the driving wire wheel; and

[0024] The fifth drive cable has a winding direction opposite to that of the fourth drive cable. One end of the fifth drive cable is fixed to the driven wire wheel, and the other end is fixed to the driving wire wheel after being twisted around the driven wire wheel and the driving wire wheel.

[0025] A further technical solution is that the shoulder motion module further includes:

[0026] The first tensioning mechanism includes a tensioning seat fixed on a base, in which a first tensioning wheel and a second tensioning wheel are fixed in a floating manner, the first tensioning wheel and the second tensioning wheel can approach or move away from the driven line wheel, the fourth drive cable is wound around the first tensioning wheel, and the fifth drive cable is wound around the second tensioning wheel.

[0027] A further technical solution is that two parallel long sliding holes are provided on the upper and lower end plates of the tensioning seat, and a sliding rod is slidably provided in each sliding hole. A first spring is fixed between the sliding rod and the side plate of the tensioning seat, and the first tensioning wheel and the second tensioning wheel are respectively fixed on the corresponding sliding rod.

[0028] A further technical solution is that a concave-convex fitting interlocking structure is provided between two contacting guide surfaces on the two joint seats.

[0029] A further technical solution is that a limiting cable is provided between two contacting guide surfaces on the two joint seats, and limiting grooves are provided on the outer edges around the rolling plates. The limiting cable is embedded in the limiting groove of a rolling plate, and its two ends are respectively fixed to the rolling plates on the two joint seats.

[0030] A further technical solution is that a planetary gear reducer is fixed on the upper fixed frame, and the driving shaft is the central axis of the planetary gear reducer.

[0031] A further technical solution is that the upper arm is also provided with a reeling shaft D which is rotatably fixed transversely;

[0032] The second driving unit comprises:

[0033] A capstan drive assembly includes a capstan shaft rotatably fixed on a lower fixing frame, a capstan being fixed at the proximal end of the capstan shaft, and two direction-changing wheels rotatably fixed on the lower fixing frame, wherein the axes of the direction-changing wheels are perpendicular to the capstan shaft;

[0034] A universal joint shaft, with universal joints at both ends, wherein the distal end of the universal joint shaft is fixed to the driving shaft, and the proximal end is fixed to the capstan shaft;

[0035] A sixth driving cable, the middle of which is wound on the capstan, one end of which is led out toward the proximal end through a changing wheel and then wound on the winding shaft D in a forward direction, and the other end of which is led out toward the proximal end through another changing wheel and then wound on the winding shaft D in a reverse direction.

[0036] A further technical solution is that the forearm and / or the forearm has a first tensioning wheel assembly for tensioning each third drive cable.

[0037] A further technical solution is that the upper arm and / or the lower arm is provided with a second tensioning wheel assembly for tensioning the two ends of the first drive cable, the second drive cable and the sixth drive cable respectively.

[0038] The beneficial effects of adopting the above technical solution are:

[0039] The wire-driven decoupling robot arm adopts a symmetrical disk design in the elbow joint, which effectively reduces the lateral overturning caused by uneven cable tension, improves the stability and load capacity during movement, and uses a tension amplification mechanism to amplify the torque and stiffness of the elbow joint without increasing the joint mass and inertia, avoiding coupling problems during elbow joint movement.

[0040] The pitch and yaw degrees of freedom of the wrist joint are realized by a two-degree-of-freedom 3-UU parallel mechanism, and the central axis roll degree of freedom is realized by a winch mechanism; the drive cable is combined with a flexible tension amplification mechanism to drive the wrist joint to achieve three-degree-of-freedom movement while improving the torque and stiffness of the wrist joint.

[0041] The shoulder joint uses a 1.5mm high-rigidity cable, and the elbow and wrist joints use a 0.8mm light-rigidity cable. The power source is far away from the end and concentrated near the shoulder joint, which reduces the inertia of movement and improves the overall strength and movement performance. BRIEF DESCRIPTION OF THE DRAWINGS

[0042] The present invention will be further described in detail below in conjunction with the accompanying drawings and specific embodiments.

[0043] Figure 1 It is a schematic diagram of the overall structure of the present invention;

[0044] Figure 2 It is a schematic diagram of the structure of the middle shoulder joint of the present invention;

[0045] Figure 3 is a schematic diagram of the shoulder joint cable drive in the present invention;

[0046] Figure 4 It is a schematic diagram of the elbow joint structure in the present invention;

[0047] Figure 5 Schematic diagram of the arrangement of the pure rolling restriction cable of the elbow joint in the present invention;

[0048] Figure 6 It is a schematic diagram of the principle of the elbow joint tension amplification mechanism of the present invention;

[0049] Figure 7 It is a decoupling analysis diagram of the elbow joint in the present invention;

[0050] Figure 8 It is a schematic diagram of the exploded structure of the wrist joint in the present invention;

[0051] Fig. 9 It is a schematic diagram of the principle structure of the third tension amplification mechanism in the present invention;

[0052] Fig.10 It is a wrist joint decoupling analysis diagram in the present invention;

[0053] Fig.11 It is a structural schematic diagram of the elbow joint in the present invention;

[0054] Fig.12 It is a structural schematic diagram of the first tensioning mechanism in the present invention;

[0055] Fig.13 It is a structural schematic diagram of the first tensioning wheel assembly in the present invention;

[0056] Fig.14 is a wiring diagram of the first drive cable and the second drive cable in the present invention;

[0057] Fig.15 is a wiring diagram of two third drive cables in the present invention;

[0058] Fig.16 is a wiring diagram of both ends of the sixth drive cable in the present invention;

[0059] Fig.17 It is a wiring diagram of the other two third drive cables in the present invention. DETAILED DESCRIPTION

[0060] The following is a clear and complete description of the technical solutions in the embodiments of the present invention in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative work are within the scope of protection of the present invention.

[0061] In the following description, many specific details are set forth to facilitate a full understanding of the present invention, but the present invention may also be implemented in other ways different from those described herein, and those skilled in the art may make similar generalizations without violating the connotation of the present invention. Therefore, the present invention is not limited to the specific embodiments disclosed below.

[0062] like Figure 1 to Figure 17 As shown, a wire-driven decoupling robot arm includes a shoulder joint 1, an upper arm 2, an elbow joint 3, a lower arm 4, a wrist joint 5 and an end effector 6 which are fixedly connected in sequence from the proximal end to the distal end.

[0063] The shoulder joint 1 includes three shoulder motion modules, each of which has a rotating part with a single rotational degree of freedom. The three shoulder motion modules are fixed in sequence so that the rotation axes of the three rotating parts are arranged perpendicular to each other.

[0064] Specific as Figure 2 and 3 As shown, the shoulder joint 1 includes three shoulder motion modules, each of which includes a base 1-9, a driving wheel group, a fourth driving cable 1-4 and a fifth driving cable 1-8. The driving wheel group includes a driving pulley 1-10 and a driven pulley 1-3 rotatably fixed on the base 1-9. The driving pulley 1-10 is connected to a third driving part that drives it to rotate. Specifically, it can be driven to rotate by a motor. The driving pulley 1-10 is the rotating part of the shoulder joint 1 mentioned above. The shoulder joint 1 adopts a 1.5mm high-rigidity cable, and the two cables are the same length. One end of the fourth driving cable 1-4 is fixed to the driven pulley 1-3, and the other end is fixed to the driving pulley 1-10 after being twisted around the driven pulley 1-3 and the driving pulley 1-10. The winding direction of the fifth drive cable 1-8 is opposite to that of the fourth drive cable 1-4. One end of the fifth drive cable 1-8 is fixed to the driven pulley 1-3, and the other end is twisted around the driven pulley 1-3 and the driving pulley 1-10 and then fixed to the driving pulley 1-10.

[0065] When the active wire wheel 1-10 rotates counterclockwise, the fourth drive cable 1-4 is tightened and the fifth drive cable 1-8 is loosened. The rotation of the driven wire wheel 1-3 can be realized by pulling and loosening, and the single-degree-of-freedom movement of the shoulder joint 1 is realized. Based on the axis direction of the active wire wheel 1-10, three identical single-degree-of-freedom motion modules are arranged perpendicularly in space to realize the independent movement of the shoulder joint 1 with three degrees of freedom.

[0066] The shoulder joint 1 is composed of three identical single-degree-of-freedom motion modules. The motion range of the single-degree-of-freedom modular joint can reach -180° to 180°. The axes thereof intersect each other perpendicularly in space, and independent motion of three degrees of freedom can be realized.

[0067] In addition, the shoulder motion module also includes a first tensioning mechanism, such as Fig.12 As shown, it includes a tensioning seat 1-14, the tensioning seat 1-14 is fixed on the base 1-9, and the first tensioning wheel 1-5 and the second tensioning wheel 1-6 are fixed in the tensioning seat 1-14 so as to be floatable. Specifically, two parallel long sliding holes 1-11 are opened on the upper and lower end plates of the tensioning seat 1-14, and a sliding rod 1-12 is slidably provided in each sliding hole 1-11, and a first spring 1-13 is fixed between the sliding rod 1-12 and the side plate of the tensioning seat 1-14, and the first tensioning wheel 1-5 and the second tensioning wheel 1-6 are respectively fixed on the corresponding sliding rod 1-12. Through the setting of the second spring, the first tensioning wheel 1-5 and the second tensioning wheel 1-6 can be close to or away from the driven line wheel 1-3, the fourth drive cable 1-4 is wound around the first tensioning wheel 1-5, and the fifth drive cable 1-8 is wound around the second tensioning wheel 1-6. The two tensioning wheels on the first tensioning mechanism are pulled by springs. When the cable is loose, the spring pulls the cable to tighten. The direction of the spring force is opposite to the direction of the cable contraction force, thereby achieving the tensioning effect and keeping the tension of the drive cable constant.

[0068] The proximal end of the upper arm 2 is fixed to the rotating part of the distal end of the shoulder joint 1, and the upper arm 2 is provided with transversely rotatable and fixed winding shafts A2-1, B2-2, C2-3 and D2-4. In the figure, in order to avoid the four winding shafts from interfering with each other in space, the winding shaft A2-1 and the winding shaft D2-4 are connected by a bearing joint, so that the winding shaft A2-1 and the winding shaft D2-4 are coaxially arranged, but they rotate separately without affecting each other, so that the winding shaft A2-1, B2-2, C2-3 and D2-4 form a triangular arrangement, avoiding mutual influence between multiple cables.

[0069] Each winding shaft is connected to a first driving part for driving the winding shaft to rotate. The first driving part can be a motor. The motor can be driven coaxially with each winding shaft, or the motor can drive a synchronous pulley assembly to achieve transmission.

[0070] The elbow joint 3 includes two joint seats 3-3, a first tension amplifying mechanism and a second tension amplifying mechanism.

[0071] Each joint seat 3-3 is U-shaped, and has vertically arranged rolling plates on its opposite left and right sides. The end surface of the rolling plate on the opening side of the joint seat 3-3 (i.e., the thickness surface of the rolling plate) is a guide surface. The lower section of the guide surface is a vertical limiting section, and the upper section is a rolling section with a circular chamfer. The openings of the two joint seats 3-3 are arranged relatively to each other, and the corresponding guide surfaces are in contact with each other. The guide surface can limit the rotation angle of the joint seat 3-3, so that the small arm 4 can only be angled inward relative to the upper arm 2, and cannot be angled outward, which is the same as the movement direction of the human elbow joint 3. A central axis is transversely fixed in the middle of the two joint seats 3-3, and a connecting rod 3-1 is provided between the two central axes. Both ends of the connecting rod 3-1 are provided with U-shaped inclined openings, and bearings are embedded in the inner side to achieve rotatable fixation with the corresponding central axis. Through the connection of the connecting rod 3-1, the movement range of the two joint seats 3-3 is limited so that they always keep the disk surface in contact. Moreover, the single joint seat 3-3 adopts a symmetrical structural design, which can effectively prevent the lateral overturning problem caused by asymmetric force during the online driving process.

[0072] In addition, the two contacting guide surfaces on the two joint seats 3-3 have a concave-convex fitting structure. A 2mm groove 3-8 is provided on one guide surface, and a 2mm height protrusion 3-7 is provided at a corresponding position on the other guide surface. The cooperation between the groove 3-8 and the protrusion 3-7 enables the elbow joint 3 to move in a predetermined direction.

[0073] In order to realize the pure rolling motion of the elbow joint 3, a limiting cable 3-9 is provided between the two contacting guide surfaces on the two joint seats 3-3, and a limiting groove 3-4 is provided on the outer edge of the rolling plate. The limiting cable 3-9 is embedded in the limiting groove 3-4 of one rolling plate, and its two ends are respectively fixed to the rolling plates on the two joint seats 3-3. Figure 5 The limiting cable 3-9 is arranged on the limiting groove 3-4 on the surface of the rolling plate, and the two ends are respectively fixed to the fixing holes. During the movement, the limiting cable 3-9 is always in contact with the cable limiting groove 3-4 on the surface of the elbow joint 3, which can provide contact tension for the elbow joint 3 to achieve pure rolling movement without relative sliding.

[0074] In order to ensure the stability and load capacity of the wire-driven elbow joint 3 when performing single-degree-of-freedom motion, the first tension amplification mechanism and the second tension amplification mechanism are used to work together.

[0075] The first tension amplification mechanism includes a first drive cable 3-10 and two first shafts 3-12 symmetrically fixed in two joint seats 3-3, and a multi-groove first wire wheel is rotatably fixed on the two first shafts 3-12. A multi-groove outlet wire wheel is rotatably fixed on a central axis at the proximal end. After the first drive cable 3-10 is wound around the two first wire wheels for n1 turns, it is wound out through the outlet wire wheel and is forwardly wound around the winding shaft A2-1.

[0076] The second tension amplification mechanism includes a second drive cable 3-11 and two second shafts 3-13 symmetrically fixed in two joint seats 3-3, and multi-groove second wire wheels are rotatably fixed on the two second shafts 3-13. After the second drive cable 3-11 is wound around the two second wire wheels for n2 turns, it is wound out through the outlet wire wheel and reversely wound around the winding shaft A2-1.

[0077] On the winding shaft A2-1, the winding direction of the first drive cable 3-10 is opposite to the winding direction of the second drive cable 3-11. In order to ensure the pure rolling of the elbow joint, when the winding shaft A rotates, the first drive cable 3-10 and the second drive cable 3-11 are retracted and released respectively, and the length changes of the two are the same.

[0078] In the figure, n1=n2 and n=3, the first drive cable 3-10 and the second drive cable 3-11 are both wound three times, and the number of unidirectional cables of the first drive cable 3-10 and the second drive cable 3-11 are both 6.

[0079] The solid and dotted lines of the first drive cable 3-10 and the second drive cable 3-11 produce antagonistic movements to achieve flexion and extension of the elbow joint 3. There are three coaxially arranged pulleys at both ends of the tension amplification mechanism. The pulleys are provided with U-shaped grooves. The drive cables are wound around the pulleys through the grooves. The drive cables are wound from one end to the opposite pulley at the same position. After repeating three times, they are wound out and connected to the power source. When the tension T0 generated by the power source traction cable is wound around 3 turns, the total number of cables is 6. For a single cable, the force T1=6T0 output after the tension amplification mechanism can be deduced; and because the total displacement of the cable x0=6x1, the stiffness output by the tension amplification mechanism can be obtained: (Wherein: tension T0, output force T1, total displacement x0, single cable displacement x1, output stiffness K1 after tension amplification, original stiffness K0, cable stiffness coefficient k) The present invention improves the output torque and stiffness of the tension amplification mechanism by increasing the number of cables.

[0080] like Figure 8 and 9As shown, the wrist joint 5 includes an upper fixed frame 5-5, a lower fixed frame 5-7, a UU parallel mechanism and four sets of third tension amplification mechanisms 5-2. A driving shaft is rotatably fixed on the upper fixed frame 5-5, and both ends of the driving shaft pass through the upper fixed frame 5-5. Preferably, a planetary gear reducer 5-4 is fixed on the upper fixed frame 5-5, and the driving shaft is the central axis of the planetary gear reducer. The planetary gear reducer 5-4 is added at the terminal output shaft to achieve the effect of deceleration and torque increase. The distal end of the driving shaft is fixed to the end effector 6, and the end effector 6 can be replaced according to usage requirements. A second driving part that drives it to rotate is connected to the driving shaft. The lower fixed frame 5-7 is fixed to the joint seat 3-3 at the distal end of the elbow joint 3. The UU parallel mechanism is fixed between the upper fixed frame 5-5 and the lower fixed frame 5-7. The 3-UU parallel mechanism 5-6 belongs to the prior art. It consists of three special-shaped connecting rods evenly distributed along the circumference at intervals of 120°, and the upper and lower ends are respectively connected to the upper and lower fixed frames 5-7 through universal joints. Four groups of third tension amplification mechanisms 5-2 are evenly surrounded on the outside of the 3-UU parallel mechanism 5-6. The four groups of third tension amplification mechanisms 5-2 are placed in the front, back, left and right of the 3-UU parallel mechanism 5-6. Each group of third tension amplification mechanisms 5-2 includes an upper pulley group and a lower pulley group. The upper pulley group is fixed on the upper fixed frame 5-5 and has two pulleys arranged up and down. The lower pulley group is fixed on the lower fixed frame 5-7 and has two pulleys arranged up and down. A third drive cable 5-8 is wound between the four pulleys, and the free end of the third drive cable 5-8 is led out toward the proximal end through the lead-out guide wheel 5-9. The two third drive cables 5-8 on the front and rear sides are led out and wound on the reel B2-2 in a positive and negative direction. The reel B2-2 rotates to drive the front and rear third drive cables 5-8 to be retracted and released. The two third drive cables 5-8 on the left and right sides are led out and wound on the reel C2-3 in a positive and negative direction. The reel C2-3 rotates to drive the left and right third drive cables 5-8 to be retracted and released.

[0081] In the wrist joint 5, the second driving part includes a winch driving assembly 5-1, a universal joint shaft 5-3 and a sixth driving cable 5-13. The winch driving assembly 5-1 includes a winch shaft, which is rotatably fixed on the lower fixed frame 5-7, and a winch 5-11 is fixed to the proximal end of the winch shaft, and also includes two direction-changing wheels 5-12 rotatably fixed to the lower fixed frame 5-7, and the axis of the direction-changing wheels 5-12 is perpendicular to the winch shaft. Both ends of the universal joint shaft 5-3 have universal joints, and the distal end of the universal joint shaft 5-3 is fixed to the driving shaft, and the proximal end is fixed to the winch shaft. The middle part of the sixth drive cable 5-13 is wound around the winch 5-11, one end is led out toward the proximal end through a changing wheel 5-12 and then wound forwardly around the winding shaft D2-4, and the other end is led out toward the proximal end through another changing wheel 5-12 and then wound reversely around the winding shaft D2-4. By driving the winding shaft D2-4 to rotate, the two ends of the sixth drive cable 5-13 can be retracted and released, thereby driving the winch 5-11 to rotate.

[0082] In order to realize the three degrees of freedom of the wrist joint 5, namely, pitch, yaw and roll, the yaw and pitch degrees of freedom of the wrist joint 5 are converted into a spherical pure rolling parallel mechanism, and the roll degree of freedom is realized by the rotation of the universal joint shaft 5-3.

[0083] The principle of the 3-UU parallel mechanism 5-6 is: within a certain error tolerance range, the anti-parallelogram mechanism is used to realize the equivalent of pure rolling of an elliptical path to pure rolling of a pure circular path. The driving cable acts on the front and rear third tension amplification mechanisms 5-2 to realize the pitching movement of the wrist joint 5, and the left and right third tension amplification mechanisms 5-2 to realize the yaw movement of the wrist joint 5.

[0084] The second driving unit uses the changing wheel 5-12 and the winch 5-11 to convert the linear motion of the sixth driving cable 5-13 into rotation around the axis. The winch shaft transmits the driving force of the driving cable to the planetary gear reducer 5-4 through the universal joint shaft 5-3. The planetary gear reducer 5-4 decelerates and increases the torque, and finally transmits it to the end effector 6, thereby realizing the rolling motion of the wrist joint 5.

[0085] On the basis of the tension magnification mechanism mentioned in the elbow joint 3, the wrist joint 5 uses the third tension magnification mechanism 5-2, which adopts the method of installing the guide wheels in the same plane, and reduces the space occupied by the wrist joint 5 compared with the coaxial installation of two pairs of guide wheels in the traditional tension magnification mechanism. Since the main friction between the drive cable and the guide wheel is rolling friction, the third tension magnification mechanism 5-2 places the guide wheel grooves in the same plane, which greatly reduces the drive loss caused by friction, improves the transmission efficiency of the line drive and prolongs the service life of the drive cable.

[0086] The third tension amplification mechanism 5-2 has a winding number of n=4, and a driving cable tension of T′0. The same as the tension amplification mechanism of the elbow joint 3, it can be seen that T1′=4T′0, K′1=n 2 K'0=4 2 K'0=16K'0, (wherein: output force T1', tension T'0, original stiffness K'0, output stiffness K'0 after tension amplification mechanism, number of winding wires n) can verify that the third tension amplification mechanism 5-2 can achieve an increase in the torque and stiffness of the wrist joint 5.

[0087] From the foregoing, the single-degree-of-freedom motion of the elbow joint 3 is a pure rolling motion without relative sliding, and the wrist joint 5 is a spherical pure rolling motion under the action of the 3-UU parallel mechanism 5-6 and the third tension amplification mechanism 5-2. When the joint moves, the drive cable transmits the driving force under the antagonistic effect to realize the joint freedom. If the cable length changes during the process, it will cause the cable to break due to uneven force and a sharp increase in force. Therefore, ensuring that the total length of the cable remains unchanged is the key to solving the coupling problem. Starting from the perspective of space vectors, the present invention decouples the movements of the elbow joint 3 and the wrist joint 5 to make the joint movements independent of each other.

[0088] While transmitting driving force, the driving cable also faces the antagonism between cables. The independent and stable movement between joints needs to ensure that the total length of the cables under the mutual antagonism remains unchanged or the change amount remains the same. Therefore, from the perspective of space vectors, the decoupling analysis and verification of the elbow and wrist joints 5 during the movement are carried out based on the closed-loop vector triangle principle.

[0089] like Figure 7 As shown: the movement angle of elbow joint 3 θ=∠x2O2x1, the total length of the cable on the first tension amplification mechanism is l1, the total length of the cable on the second tension amplification mechanism is l2, the center distance of the pure rolling disc is S, A1, A2, B1, B2 are the center positions of the guide wheels at both ends of the tension amplification mechanism, |A1A2|=|B1B2|=l; the homogeneous transformation matrix between the static coordinate system O1-x1y1z1 and the dynamic coordinate system O2-x2y2z2 is The coordinates of A1 and A2 in the static coordinate system O1-x1y1z1 can be expressed as 1 A1. 1 The coordinates of A2, B1, and B2 in the moving coordinate system O2-x2y2z2 can be expressed as 2 B1. 2 B2. It can be deduced that in vector triangle A i O i B i The cable length l1=n|A1B1|=n| 1 B1- 1 A1|=n|12T· 2 B1-1 A1|,l2=n|A2B2|=n| 1 B2- 1 A2|=n|12T· 2 B2- 1 A2|. It can be verified that as the joint angle changes, the cable length changes in the opposite direction, and the amount of change is always the same. The movements of the cables are independent of each other, realizing the decoupling of the wire-driven elbow joint 3.

[0090] like Fig.10 As shown: In order to more intuitively analyze the decoupling of wrist joint 5, wrist joint 5 is now equivalent to base 1-9 + dynamic platform. Both ends of the drive cable are fixed to A i B i At i = 1, 2, 3, 4, the length is l i , the base coordinate system O1-x1y1z1 and the moving coordinate system O2-x2y2z2 are defined at the geometric center of the base 1-9 and the moving platform, O1O2 and the normal of the moving platform determine the bending plane, the attitude angle θ is the projection angle between the z1 axis and the z2 axis on the bending plane, and the direction angle φ is the angle between the x1 axis and the bending plane. The homogeneous transformation matrix between the base coordinate system O1-x1y1z1 and the moving coordinate system O2-x2y2z2 is A i In the base 1-9 scale system O1-x1y1z1, it can be expressed as 1 A i , B i In the moving coordinate system O2-x2y2z2, it can be expressed as 2 B i , it can be deduced that in the vector triangle A i O1B i Medium cable length It can be verified that the length variation range of each cable is the same. With the changes of the direction angle φ and the attitude angle θ, the changes of the cable lengths l1 and l3, l2 and l4 show an opposite trend of stretching and contracting at the same time, and do not affect each other.

[0091] like Fig.13As shown, in the middle of the forearm 4 or the lower middle of the upper arm 2, there is a first tensioning wheel assembly 4-10 for tensioning each third drive cable 5-8, which is used to tension the drive cable of the driving wrist joint 5. The first tensioning wheel assembly 4-10 includes four first mounting rods 4-1, four first swing arms 4-2 and four first torsion springs 4-3. The four first mounting rods 4-1 are fixed on the forearm 4. The four first swing arms 4-2 are rotatably fixed on the first mounting rods 4-1, and a third tensioning wheel 4-4 is provided at the end of the first swing arm 4-2. The four third tensioning wheels 4-4 are arranged in an alternating manner and do not affect the passage of the cable. The four first torsion springs 4-3 are respectively sleeved on each first mounting rod 4-1, and the two ends of the first torsion spring 4-3 are respectively fixed to the forearm 4 and the first swing arm. The four third drive cables are respectively wound around a third tensioning wheel 4-4.

[0092] In the middle of the forearm 4 or the lower middle of the upper arm 2, there is a second tensioning wheel assembly 2-10 for tensioning the two ends of the first drive cable 3-10, the second drive cable 3-11 and the sixth drive cable 5-13, respectively, for tensioning the drive cables to ensure the transmission of the driving force. The second tensioning wheel assembly 2-10 has the same structure as the first tensioning wheel assembly 4-10, and the second tensioning wheel assembly 2-10 includes four second mounting rods, four second swing arms and four second torsion springs. The four second mounting rods are fixed on the upper arm 2; the four second swing arms are rotatably fixed on the second mounting rods, and a fourth tensioning wheel is provided at the end of the second swing arm, and the four fourth tensioning wheels are arranged alternately; the four second torsion springs are respectively mounted on each second mounting rod, and the two ends of the second torsion spring are respectively fixed to the upper arm 2 and the second swing arm; the two ends of the first drive cable 3-10, the second drive cable 3-11 and the sixth drive cable 5-13 are respectively wound around a fourth tensioning wheel.

[0093] In the robot arm, during the wiring process, each drive cable can also be guided by a number of guide wheels 01 fixed on the arm to ensure the effective driving of each drive cable.

[0094] The above are only preferred embodiments of the present invention. Any simple modification, deformation and equivalent substitution made by anyone to the present invention based on the contents of the present invention shall fall within the protection scope of the present invention.

Claims

1. A wire-driven decoupling robot arm, comprising a shoulder joint (1), an upper arm (2), an elbow joint (3), a lower arm (4), a wrist joint (5) and an end effector (6) which are fixedly connected in sequence from the proximal end to the distal end, characterized in that: The shoulder joint (1) comprises three shoulder motion modules, each shoulder motion module has a rotating part with a single rotational degree of freedom, and the three shoulder motion modules are fixed in sequence so that the rotation axes of the three rotating parts are arranged perpendicular to each other; The proximal end of the upper arm (2) is fixed to the rotating part of the distal end of the shoulder joint (1), and the upper arm (2) is provided with a winding shaft A (2-1), a winding shaft B (2-2) and a winding shaft C (2-3) which are laterally rotatable and fixed, and each winding shaft is connected to a first driving part which drives it to rotate; The elbow joint (3) comprises: Two joint seats (3-3), the joint seats (3-3) are U-shaped, and have vertically arranged rolling plates on opposite sides thereof, the end surface of the rolling plate located on the opening side of the joint seat (3-3) is a guide surface, the lower section of the guide surface is a vertical limiting section, and the upper section is a rolling section with a circular arc chamfer, the openings of the two joint seats (3-3) are arranged opposite to each other, and the corresponding guide surfaces are in contact with each other, a central axis is transversely fixed in the middle of the two joint seats (3-3), a connecting rod (3-1) is provided between the two central axes, and both ends of the connecting rod (3-1) are rotatably fixed to the corresponding central axis; The first tension amplification mechanism comprises a first drive cable (3-10) and two first shafts (3-12) symmetrically fixed in two joint seats (3-3), and the two first shafts (3-12) are rotatably fixed with multi-groove first wire wheels, and the first drive cable (3-10) is wound between the two first wire wheels for n1 turns and then led out toward the proximal end and wound forwardly on the winding shaft A (2-1); The second tension amplification mechanism comprises a second drive cable (3-11) and two second shafts (3-13) symmetrically fixed in two joint seats (3-3), and the two second shafts (3-13) are rotatably fixed with multi-groove second wire wheels, and the second drive cable (3-11) is wound around the two second wire wheels for n2 turns and then led out toward the proximal end and reversely wound around the winding shaft A (2-1); The wrist joint (5) comprises: An upper fixed frame (5-5), on which a driving shaft is rotatably fixed, two ends of the driving shaft pass through the upper fixed frame (5-5), a distal end of the driving shaft is fixed to an end effector (6), and the driving shaft is connected to a second driving part for driving the driving shaft to rotate; A lower fixing frame (5-7) fixed to a joint seat (3-3) at the distal end of the elbow joint (3); A 3-UU parallel mechanism (5-6) is fixed between an upper fixing frame (5-5) and a lower fixing frame (5-7); Four groups of third tension amplification mechanisms (5-2) are evenly surrounded on the outside of the 3-UU parallel mechanism (5-6). The four groups of third tension amplification mechanisms (5-2) are respectively arranged in front, rear, left and right of the 3-UU parallel mechanism (5-6). Each group of third tension amplification mechanisms (5-2) comprises an upper pulley group and a lower pulley group. The upper pulley group is fixed on the upper fixed frame (5-5), and the lower pulley group is fixed on the lower fixed frame (5-7). A third driving cable (5-8) is wound between the upper pulley group and the lower pulley group. The free end of the third driving cable (5-8) is led out toward the proximal end through a lead-out guide wheel (5-9); The two third drive cables (5-8) on the front and rear sides are led out and wound on the reel B (2-2) in a forward and reverse manner, and the two third drive cables (5-8) on the left and right sides are led out and wound on the reel C (2-3) in a forward and reverse manner and fixed.

2. A wire-driven decoupling robot arm according to claim 1, characterized in that: The shoulder joint (1) comprises three shoulder motion modules, each of which comprises: Base (1-9); The driving wheel assembly comprises a driving wheel (1-10) and a driven wheel (1-3) rotatably fixed on a base (1-9), wherein the driving wheel (1-10) is connected to a third driving part for driving the driving wheel (1-10) to rotate, and the driving wheel (1-10) is the rotating part of the shoulder joint (1); A fourth driving cable (1-4) (1-4), one end of which is fixed to the driven wire wheel (1-3), and the other end of which is twisted around the driven wire wheel (1-3) and the driving wire wheel (1-10) and then fixed to the driving wire wheel (1-10); and The fifth drive cable (1-8) is wound in the opposite direction to the fourth drive cable (1-4); one end of the fifth drive cable (1-8) is fixed to the driven wire wheel (1-3), and the other end is twisted around the driven wire wheel (1-3) and the driving wire wheel (1-10) and then fixed to the driving wire wheel (1-10).

3. A wire-driven decoupling robot arm according to claim 2, characterized in that: The shoulder motion module also includes: The first tensioning mechanism comprises a tensioning seat (1-14) fixed on a base (1-9), a first tensioning wheel (1-5) and a second tensioning wheel (1-6) being fixed in a floating manner in the tensioning seat (1-14), the first tensioning wheel (1-5) and the second tensioning wheel (1-6) being able to approach or move away from a driven line wheel (1-3), the fourth drive cable (1-4) (1-4) being wound around the first tensioning wheel (1-5), and the fifth drive cable (1-8) being wound around the second tensioning wheel (1-6).

4. A wire-driven decoupling robot arm according to claim 3, characterized in that: The upper and lower end plates of the tensioning seat (1-14) are both provided with two parallel long sliding holes (1-11), and a sliding rod (1-12) is slidably arranged in each sliding hole (1-11), and a first spring (1-13) is fixed between the sliding rod (1-12) and the side plate of the tensioning seat (1-14), and the first tensioning wheel (1-5) and the second tensioning wheel (1-6) are respectively fixed on the corresponding sliding rod (1-12).

5. The wire-driven decoupling robot arm according to claim 1, characterized in that: There is a concave-convex fitting interlocking structure between two contacting guide surfaces on the two joint seats (3-3).

6. The wire-driven decoupling robot arm according to claim 1, characterized in that: A limiting cable (3-9) is provided between two contacting guide surfaces on the two joint seats (3-3), and limiting grooves (3-4) are provided on the outer edges around the rolling plate. The limiting cable (3-9) is embedded in the limiting groove (3-4) of a rolling plate, and its two ends are respectively fixed to the rolling plates on the two joint seats (3-3).

7. The wire-driven decoupling robot arm according to claim 1, characterized in that: A planetary gear reducer (5-4) is fixed on the upper fixed frame (5-5), and the driving shaft is the central axis of the planetary gear reducer.

8. The wire-driven decoupling robot arm according to claim 1, characterized in that: The upper arm (2) is also provided with a reeling shaft D (2-4) which is rotatably fixed in a transverse direction; The second driving unit comprises: A winch drive assembly (5-1) comprises a winch shaft rotatably fixed on a lower fixing frame (5-7), a winch (5-11) being fixed at the proximal end of the winch shaft, and two direction-changing wheels (5-12) rotatably fixed on the lower fixing frame (5-7), wherein the axes of the direction-changing wheels (5-12) are perpendicular to the winch shaft; A universal joint shaft (5-3) having universal joints at both ends, wherein the distal end of the universal joint shaft (5-3) is fixed to the driving shaft, and the proximal end is fixed to the capstan shaft; A sixth drive cable (5-13) is wound around the winch (5-11) in the middle, one end of which is led out toward the proximal end via a direction-changing wheel (5-12) and then wound around the winding shaft D (2-4) in the forward direction, and the other end of which is led out toward the proximal end via another direction-changing wheel (5-12) and then wound around the winding shaft D (2-4) in the reverse direction.

9. The wire-driven decoupling robot arm according to claim 1, characterized in that: The forearm (4) and / or the upper arm (2) is provided with a first tensioning wheel assembly (4-10) for tensioning each third driving cable (5-8).

10. The wire-driven decoupling robot arm according to claim 8, characterized in that: The forearm (4) and / or the upper arm (2) is provided with a second tensioning wheel assembly (2-10) for tensioning the two ends of the first drive cable (3-10), the second drive cable (3-11) and the sixth drive cable (5-13) respectively.

Citation Information

Patent Citations

  • Rope-driven seven-freedom-degree humanoid manipulator based on parallel mechanism

    CN110666833A

  • Bionic rope-driven four-degree-of-freedom arm for man-machine cooperation

    CN112476478A

  • Rope-driven elbow and wrist joint module, mechanical arm and robot

    CN115107014A

  • Rope-driven mechanical arm

    CN117245636A

  • Rope-pulled mechanical arm and manipulator integrated system

    CN118205009A