A rope-driven, high-load-ratio, seven-degree-of-freedom anthropomorphic agile robotic arm

By placing the shoulder and rear-end joint drive motor on a fixed base in a seven-degree-of-freedom anthropomorphic agile robot arm with a rope drive high load-to-load ratio, the multi-joint passive decoupling mechanism is used to solve the problem of large inertia and poor flexibility in traditional robot arms. The problem is that it realizes a lightweight design and high flexibility, suitable for human-computer interaction scenarios.

CN118849044BActive Publication Date: 2024-12-06HARBIN INSTITUTE OF TECHNOLOGY (SHENZHEN) (INSTITUTE OF SCIENCE AND TECHNOLOGY INNOVATION HARBIN INSTITUTE OF TECHNOLOGY SHENZHEN) +1
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202411343198.3
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-09-25
Publication Date
2024-12-06
Estimated Expiration
2044-09-25

AI Technical Summary

Technical Problem

The traditional series rigid robotic arm joint is located at the movable end, resulting in large inertia and poor flexibility, which cannot meet the needs of high-speed motion, and is insufficient in safety in human-computer interaction scenarios.

Method used

The rope drive high load-to-load ratio seven-degree-of-freedom personified agile robot arm is adopted, through the fixed base, shoulder joint, first decoupling mechanism, first arm, elbow joint, second arm and wrist joint, Place the shoulder and rear end joint drive motor on a fixed base, and use the multi-joint passive decoupling mechanism to reduce the weight and inertia of the robot to achieve decoupling of the rope.

Benefits of technology

Without increasing the size of the moving part of the robot arm, decoupling of the series multi-joint rope is achieved, reducing the weight and inertia of the robot arm, meeting the agile requirements of the agile robot arm, with 7 degrees of freedom, good flexibility, suitable for Human-computer interaction scenario.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118849044B_ABST
    Figure CN118849044B_ABST
Patent Text Reader

Abstract

The present invention relates to a rope-driven high-load-ratio seven-degree-of-freedom anthropomorphic agile manipulator, comprising a fixed base, a shoulder joint, a first decoupling mechanism, a first arm, an elbow joint, a second arm and a wrist joint connected in sequence. The rope-driven high-load-ratio seven-degree-of-freedom anthropomorphic agile manipulator is a series shoulder joint mechanism with rope-driven multi-joint passive decoupling, which can realize the decoupling of the series multi-joint rope without increasing the size of the active part of the manipulator, and place the shoulder and rear end joint drive motors on the fixed base, thereby reducing the weight and inertia of the manipulator and meeting the dexterity requirements of the agile manipulator.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of mechanical arms, and in particular to a rope-driven, high-load-ratio, seven-degree-of-freedom anthropomorphic agile mechanical arm. Background Art

[0002] Traditional serial rigid robotic arm joints generally use a direct connection method of motor plus harmonic reducer. The motor is still located at the active end of the robotic arm. The inertia and mass of the joints are large, the flexibility is poor, and it cannot meet the needs of high-speed movement of the robotic arm.

[0003] Compared with traditional rigid robotic arms, rope-driven robotic arms can place the motor at the base or shoulder joint of the robotic arm, reducing the mass and inertia of the robotic arm. At the same time, rope-driven robotic arms have the advantages of low stiffness and good flexibility, making them more suitable for human-computer interaction scenarios and improving safety. Summary of the invention

[0004] The present invention provides a rope-driven, high-load ratio, seven-degree-of-freedom anthropomorphic agile manipulator and a control method thereof, aiming to solve at least one of the technical problems existing in the prior art.

[0005] The technical solution of the present invention is a rope-driven high-load ratio seven-degree-of-freedom anthropomorphic agile manipulator, comprising a fixed base, a shoulder joint, a first decoupling mechanism, a first arm lever, an elbow joint, a second arm lever and a wrist joint connected in sequence;

[0006] The shoulder joint has three degrees of freedom, including a shoulder swivel joint, a shoulder pitch joint and a shoulder swivel joint, and the shoulder swivel joint is connected to the fixed base;

[0007] The first decoupling mechanism has one rotational degree of freedom, the first decoupling mechanism is connected between the shoulder second pitch joint and the shoulder third rotation joint of the shoulder joint, and the first decoupling mechanism is used to decouple the rear end rope;

[0008] The elbow joint has one degree of freedom, and the end of the first arm and the starting end of the second arm are respectively connected to the elbow joint;

[0009] The wrist joint has three degrees of freedom, and the wrist joint is connected to the end of the second arm;

[0010] The fixed base is provided with a second decoupling mechanism, the second decoupling mechanism has two degrees of freedom, and the second decoupling mechanism is connected between the fixed base and the shoulder joint.

[0011] Further, it also includes a driving source, wherein the driving source includes a first driving source, a second driving source, a third driving source, a fourth driving source, a fifth driving source and a sixth driving source;

[0012] The first driving source and the second driving source are arranged on the fixed base, and the first driving source and the second driving source are used to drive the shoulder joint to move;

[0013] The third driving source and the fourth driving source are arranged on the fixed base, and the third driving source and the fourth driving source are used to drive the elbow joint to move;

[0014] The fifth driving source and the sixth driving source are disposed on the first arm, and the fifth driving source and the sixth driving source are used to drive the wrist joint to move.

[0015] Furthermore, the driving source is connected to the driven joints through corresponding transmission ropes, and the driving source is connected to the joint driving wheel. The joint driving wheel adopts a spiral line arrangement to prevent the driving rope from falling off. The driving rope includes an opening and closing rope and a retraction rope, and the opening and closing rope and the retraction rope are respectively located on both sides of the joint driving wheel.

[0016] Furthermore, the opening and closing rope and the contraction rope are wound around the joint driving wheel, and the winding directions of the opening and closing rope and the contraction rope on the joint driving wheel are opposite.

[0017] Further, the elbow joint includes a first driving winding wheel, a second driving winding wheel, a coupling winding wheel, a coupling driving rope, a decoupling winding wheel, an elbow joint bracket, an elbow joint connecting rod and an elbow rotating shaft,

[0018] The coupling drive rope is wound in an "8" shape, and the driving source drives the elbow joint to produce pure rolling motion through the transmission rope, thereby driving the second arm to move relative to the first arm. The rope length passing through the elbow joint remains unchanged, thereby achieving decoupling of the wrist drive rope.

[0019] Further, the wrist joint includes a differential transmission wheel, a wrist bracket, a first drive wheel, a second drive wheel, a universal transmission shaft, a differential coupling rope, a first wrist joint, a second wrist joint and a third wrist joint;

[0020] The first wrist joint and the second wrist joint are driven in parallel with differential speed, and the third wrist joint transmits rotary motion through the universal transmission shaft.

[0021] Further, the first decoupling mechanism includes a driving gear, a follower gear, a fixed gear, a transmission shaft, a shoulder coupling winding wheel, a follower bracket, a follower pulley set, and a fixed coupling winding wheel;

[0022] The driving gear is connected to the shoulder three rotation joint through the transmission shaft, the shoulder coupling winding wheel is connected to the transmission shaft through a bearing, the follower gear is connected and fixed to the follower bracket through a bearing, the follower bracket is connected to the transmission shaft through a bearing, the follower pulley group is fixed to the follower bracket, the follower pulley group rotates around the transmission shaft, the fixed gear and the fixed coupling winding wheel are fixed to the shoulder two pitch joints, and the fixed coupling winding wheel is connected to the transmission shaft through a bearing.

[0023] Furthermore, the driving gear, the follower gear, and the fixed gear form a planetary gear train, forming a differential gear set, and the driving gear is When rotating, the follower gear rotates around the transmission shaft Rotate.

[0024] Furthermore, the first decoupling mechanism further includes an elbow drive rope, which passes through the shoulder coupling winding wheel, the follower pulley set, and the fixed coupling winding wheel in sequence, and the elbow drive rope can achieve that the elbow rope length remains unchanged when the shoulder three-turn joint moves;

[0025] The elbow driving rope and the third shoulder driving rope can achieve decoupling of the shoulder second pitch joint, shoulder third swivel joint and elbow joint through the first pulley group and the second pulley group of the second decoupling mechanism.

[0026] Further, the second decoupling mechanism includes a base guide pulley, a base coupling wire wheel, a base reversing pulley, a first movable pulley group, a second movable pulley group, a first shoulder transmission shaft, a first shoulder coupling wheel, a linear guide rail and a slider;

[0027] When the shoulder 1 swivel joint moves, the shoulder 1 joint coupling rope drives the first movable pulley group to make linear motion, and when the shoulder 2 pitch joint moves, the shoulder 2 joint coupling rope drives the second movable pulley group to make linear motion, thereby achieving that the length of the coupling rope in the second decoupling mechanism (8) remains unchanged.

[0028] The beneficial effects of the present invention are:

[0029] The rope-driven high-load-ratio seven-degree-of-freedom anthropomorphic agile robotic arm is a rope-driven multi-joint passively decoupled serial shoulder joint mechanism, which can achieve decoupling of the serial multi-joint ropes without increasing the size of the movable part of the robotic arm, and place the shoulder and rear end joint drive motors on a fixed base, thereby reducing the weight and inertia of the robotic arm and meeting the dexterity requirements of the agile robotic arm.

[0030] The robotic arm has 7 degrees of freedom and adopts SRS joint arrangement, similar to human arms. It has spherical shoulder joints and wrist joints, pure rolling elbow joints, and a multi-joint passive decoupling mechanism. The shoulder motor and elbow motor are placed on the base, reducing the mass of the moving part of the robotic arm. The weight of the moving part of the robotic arm is less than 7kg, the arm length is 1000mm, and the load is 7kg. The robotic arm is light in weight, has 7 degrees of freedom, good flexibility, and a large working space, and can achieve most operating tasks. BRIEF DESCRIPTION OF THE DRAWINGS

[0031] Figure 1 It is an overall side view of the elbow joint bending of the rope-driven, high-load-ratio, seven-degree-of-freedom anthropomorphic agile manipulator.

[0032] Figure 2 It is an overall side view of the elbow joint of the rope-driven, high-load-ratio, seven-degree-of-freedom anthropomorphic agile manipulator extended.

[0033] Figure 3 It is a structural diagram of the shoulder joints of a rope-driven, high-load-ratio, seven-DOF anthropomorphic agile robotic arm.

[0034] Figure 4 It is the structural diagram of the first decoupling mechanism in the rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator.

[0035] Figure 5 It is a structural diagram of the second decoupling mechanism in the rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator.

[0036] Figure 6 This is a structural diagram of the windings of the joints in a rope-driven, high-load-ratio, seven-DOF anthropomorphic agile robotic arm.

[0037] Figure 7 It is a structural diagram of the elbow joint in a rope-driven, high-load-ratio, seven-DOF anthropomorphic agile robotic arm.

[0038] Figure 8 It is a structural diagram of the wrist joint in a rope-driven, high-load-ratio, seven-DOF anthropomorphic agile robotic arm.

[0039] Reference numerals: 1, fixed base; 2, shoulder joint; 3, first decoupling mechanism; 4, first arm; 5, elbow joint; 6, second arm; 7, wrist joint; 8, second decoupling mechanism; 9, driving source;

[0040] 201, shoulder swivel joint 1; 202, shoulder pitch joint 2; 203, shoulder swivel joint 3;

[0041] 21. Driving gear; 22. Follower gear; 23. Fixed gear; 24. Transmission shaft; 25. Shoulder coupling winding wheel; 26. Follower bracket; 27. Follower pulley group; 28. Fixed coupling winding wheel; 29. ​​Shoulder three winding wheel; 30. Shoulder three guide pulley; 31. Base guide pulley; 32. Base coupling wire wheel; 33. Base reversing pulley; 34. First movable pulley group; 35. Second movable pulley group; 36. First shoulder transmission shaft; 37. First shoulder coupling wheel; 38. Linear guide rail; 39. Slider;

[0042] 410, wrist joint differential rope; 411, wrist joint drive rope; 412, elbow drive rope; 413, shoulder three joint drive rope; 414, shoulder two joint coupling rope; 415, shoulder one joint coupling rope; 416, shoulder one joint drive rope; 417, shoulder two joint drive rope;

[0043] 501, first driving winding wheel; 502, second driving winding wheel; 503, coupling winding wheel; 504, coupling driving rope; 505, decoupling winding wheel; 506, elbow joint bracket; 507, elbow joint connecting rod; 508, elbow rotating shaft;

[0044] 701, differential transmission wheel; 702, wrist support; 703, first driving wheel; 704, second driving wheel; 705, universal transmission shaft;

[0045] 91. A first driving source; 92. A second driving source; 93. A third driving source; 94. A fourth driving source; 95. A fifth driving source; 96. A sixth driving source; 97. A seventh driving source. DETAILED DESCRIPTION

[0046] The following will be combined with the embodiments and drawings to clearly and completely describe the concept, specific structure and technical effects of the present invention, so as to fully understand the purpose, scheme and effect of the present invention. It should be noted that the embodiments and features in the embodiments of this application can be combined with each other without conflict.

[0047] It should be noted that, unless otherwise specified, when a feature is referred to as being "fixed" or "connected" to another feature, it may be directly fixed or connected to the other feature, or it may be indirectly fixed or connected to the other feature. In addition, the descriptions of up, down, left, right, top, bottom, etc. used in the present invention are only relative to the relative positional relationship of the components of the present invention in the drawings.

[0048] In addition, unless otherwise defined, all technical and scientific terms used herein have the same meaning as those generally understood by those skilled in the art. The terms used in this specification are only for describing specific embodiments, not for limiting the present invention. The term "and / or" used herein includes any combination of one or more related listed items.

[0049] It should be understood that, although the terms first, second, third, etc. may be used to describe various elements in the present disclosure, these elements should not be limited to these terms. These terms are only used to distinguish elements of the same type from each other. For example, without departing from the scope of the present disclosure, the first element may also be referred to as the second element, and similarly, the second element may also be referred to as the first element.

[0050] Reference Figures 1 to 8 In some embodiments, the technical solution of the present invention is a rope-driven high load ratio seven-degree-of-freedom anthropomorphic agile manipulator, referring to Figure 1 and Figure 2 The rope-driven high load ratio seven-degree-of-freedom anthropomorphic agile manipulator comprises:

[0051] It comprises a fixed base 1, a shoulder joint 2, a first decoupling mechanism 3, a first arm 4, an elbow joint 5, a second arm 6 and a wrist joint 7 which are connected in sequence;

[0052] The shoulder joint 2 has three degrees of freedom, and includes a shoulder first swivel joint 201, a shoulder second pitch joint 202, and a shoulder third swivel joint 203. The shoulder first swivel joint 201 is connected to the fixed base 1;

[0053] The first decoupling mechanism 3 has one rotational degree of freedom. The first decoupling mechanism 3 is connected between the shoulder second pitch joint 202 and the shoulder third rotation joint 203 of the shoulder joint 2. The first decoupling mechanism 3 is used to decouple the rear end rope.

[0054] The elbow joint 5 has one degree of freedom, and the end of the first arm 4 and the starting end of the second arm 6 are respectively connected to the elbow joint 5;

[0055] The wrist joint 7 has three degrees of freedom, and the wrist joint 7 is connected to the end of the second arm 6;

[0056] The fixed base 1 is provided with a second decoupling mechanism 8 , which has two degrees of freedom. The second decoupling mechanism 8 is connected between the fixed base 1 and the shoulder joint 2 .

[0057] The beneficial effects of the present invention are:

[0058] The rope-driven high-load-ratio seven-degree-of-freedom anthropomorphic agile robotic arm is a rope-driven multi-joint passively decoupled serial shoulder joint mechanism, which can achieve decoupling of the serial multi-joint ropes without increasing the size of the movable part of the robotic arm, and place the shoulder and rear end joint drive motors on a fixed base, thereby reducing the weight and inertia of the robotic arm and meeting the dexterity requirements of the agile robotic arm.

[0059] The robotic arm has 7 degrees of freedom and adopts SRS joint arrangement, similar to human arms. It has spherical shoulder joints and wrist joints, pure rolling elbow joints, and a multi-joint passive decoupling mechanism. The shoulder motor and elbow motor are placed on the base, reducing the mass of the moving part of the robotic arm. The weight of the moving part of the robotic arm is less than 7kg, the arm length is 1000mm, and the load is 7kg. The robotic arm is light in weight, has 7 degrees of freedom, good flexibility, and a large working space, and can achieve most operating tasks.

[0060] Specifically, the configuration of the rope-driven high load ratio seven-degree-of-freedom anthropomorphic agile manipulator is SRS, the joints are arranged vertically in pairs, three joints are installed horizontally, and four joints are installed vertically. The joints are positioned by vertical fixings and directly connected by threads.

[0061] The rope-driven high-load-ratio seven-degree-of-freedom anthropomorphic agile manipulator adopts three types of joints, and the joints are divided into shoulder joints, elbow joints, and wrist joints. The rope-driven high-load-ratio seven-degree-of-freedom anthropomorphic agile manipulator has seven degrees of freedom, a large range of motion, and strong flexibility. Among them, the shoulder joint 2 and the wrist joint 7 are both ball joints, and the kinematics of the manipulator are easy to obtain analytical solutions.

[0062] Reference Figure 3 The shoulder joint 2 has three rotational degrees of freedom and adopts an RPR joint configuration. The joints are perpendicular to each other and the three axes intersect at one point. The shoulder three-revolving joint 203 is provided with a first decoupling mechanism for decoupling the rear end rope.

[0063] In order to achieve low inertia of the robot arm and reduce the mass at the end of the robot arm, the first wrist joint, the second wrist joint and the driving source are placed on the first arm rod of the robot arm. The first wrist joint and the second wrist joint adopt differential transmission, and the driving wheel is placed at the elbow joint through the driving rope.

[0064] In order to achieve a lightweight design of the robotic arm, the robotic arm is provided with a first decoupling mechanism and a second decoupling mechanism, which can realize setting the elbow joint drive source and the shoulder joint drive source on the fixed base to reduce the mass of the moving part of the robotic arm.

[0065] The high-quality motor of the robot arm is set on a fixed base to achieve a lightweight design of the movable part of the robot arm. The wrist motor has a small mass. The first and second driving sources of the wrist are fixed on the first arm rod to reduce the inertia of the robot arm and simplify the mechanical structure. The third driving source of the wrist is fixed on the wrist joint to avoid motion coupling of the wrist joint 7 and simplify the structure.

[0066] Reference Figure 3 The shoulder joint 2 has three degrees of freedom, and includes a shoulder first swivel joint 201, a shoulder second pitch joint 202, and a shoulder third swivel joint 203. The shoulder first swivel joint 201 is connected to the fixed base 1;

[0067] Further, refer to Figures 1 to 3 , further comprising a driving source, wherein the driving source comprises a first driving source 91, a second driving source 92, a third driving source 93, a fourth driving source 94, a fifth driving source 95, a sixth driving source 96, and a seventh driving source 97;

[0068] The first driving source 91 and the second driving source 92 are disposed on the fixed base 1, and the first driving source 91 and the second driving source 92 are used to drive the shoulder joint 2 to move;

[0069] The third driving source 93 and the fourth driving source 94 are disposed on the fixed base 1, and the third driving source 93 and the fourth driving source 94 are used to drive the elbow joint 5 to move;

[0070] The fifth driving source 95 and the sixth driving source 96 are disposed on the first arm 4 , and the fifth driving source 95 and the sixth driving source 96 are used to drive the wrist joint 7 to move.

[0071] Specifically, the first driving source 91, the second driving source 92, the third driving source 93 and the fourth driving source 94 are fixed on the fixed base, reducing the mass and size of the shoulder joint of the robot arm, and realizing low mass and low inertia of the movable end of the robot arm. The fifth driving source 95 and the sixth driving source 96 are fixed to the end of the first arm rod of the robot arm through the elbow joint decoupling, reducing the inertia of the movable part of the robot arm.

[0072] Further, refer to Figures 1 to 3 The driving source is connected to the driven joints through corresponding transmission ropes, and the driving source is connected to the joint driving wheel. The joint driving wheel adopts a spiral line arrangement to prevent the driving rope from falling off. The driving rope includes an opening and closing rope and a contraction rope. The opening and closing rope and the contraction rope are respectively located on both sides of the joint driving wheel.

[0073] Further, refer to Figures 1 to 3The opening and closing rope and the contraction rope are wound around the joint driving wheel, and the winding directions of the opening and closing rope and the contraction rope on the joint driving wheel are opposite.

[0074] Further, refer to Figure 7 The elbow joint 5 includes a first driving winding wheel 501, a second driving winding wheel 502, a coupling winding wheel 503, a coupling driving rope 504, a decoupling winding wheel 505, an elbow joint bracket 506, an elbow joint connecting rod 507 and an elbow rotating shaft 508.

[0075] The coupling drive rope 504 is wound in an "8" shape, and the driving source drives the elbow joint 5 to generate pure rolling motion through the transmission rope, thereby driving the second arm 6 to move relative to the first arm 4. The rope length of the elbow joint 5 remains unchanged, thereby achieving decoupling of the wrist drive rope.

[0076] Specifically, the elbow rotating shaft 508 is connected to the first arm and the second arm through bearings, the elbow joint connecting rod 507 is fixed on both sides of the elbow rotating shaft 508 through threaded connection, and the elbow joint bracket 506 is connected between the two elbow connecting rods to enhance the structural rigidity. A plurality of coupling winding wheels 503 are connected to the elbow rotating shaft 508 through bearings. When the elbow joint produces pure rolling motion, the rope length of the coupling winding wheel 503 remains unchanged, thereby achieving decoupling of the wrist drive rope.

[0077] Further, refer to Figure 8 , the wrist joint 7 includes a differential transmission wheel 701, a wrist bracket 702, a first driving wheel 703, a second driving wheel 704, a universal transmission shaft 705, a differential coupling rope, a first wrist joint, a second wrist joint and a third wrist joint;

[0078] The first wrist joint and the second wrist joint are driven in parallel with differential speed, and the third wrist joint transmits rotary motion through the universal transmission shaft.

[0079] Specifically, the wrist joint 7 has three degrees of freedom, adopts an RPR joint configuration, the joints are perpendicular to each other, and the three axes intersect at one point. The first wrist joint and the second wrist joint adopt differential parallel drive, and the third wrist joint transmits rotary motion through the universal transmission shaft. The two ends of the universal transmission shaft are connected by splines. When the second wrist joint moves, the distance between the double universal joint axes can be adjusted to achieve decoupling of the terminal joint.

[0080] Further, refer to Figure 4 The first decoupling mechanism 3 includes a driving gear 21, a follower gear 22, a fixed gear 23, a transmission shaft 24, a shoulder coupling winding wheel 25, a follower bracket 26, a follower pulley set 27, and a fixed coupling winding wheel 28;

[0081] The driving gear is connected to the shoulder three rotation joint 203 through the transmission shaft, the shoulder coupling winding wheel is connected to the transmission shaft through a bearing, the follower gear is fixed to the follower bracket through a bearing, the follower bracket is connected to the transmission shaft through a bearing, the follower pulley group is fixed to the follower bracket, the follower pulley group rotates around the transmission shaft, the fixed gear and the fixed coupling winding wheel are fixed to the shoulder two pitch joint 202, and the fixed coupling winding wheel is connected to the transmission shaft through a bearing.

[0082] Specifically, the first decoupling mechanism 3 is arranged between the shoulder second pitch joint 202 and the shoulder third swivel joint 203. The shoulder third swivel joint 203 transmits the motion to the first decoupling mechanism 3 through the transmission shaft, the driving gear 21 and the shoulder third swivel joint 203 rotate at the same speed, the fixed gear 23 is fixed to the shoulder second pitch joint 202 by screw connection, the follower gear 22 and the driving gear 21 and the fixed gear 23 are meshed with each other to form a planetary gear system, forming a differential motion mechanism. The shoulder coupling winding wheel 25, the follower bracket 26, the fixed coupling winding wheel 28 and the transmission shaft 24 are connected by bearings, the driving gear 21 is arranged between the shoulder coupling winding wheel 25 and the follower bracket 26, and the fixed gear 23 is arranged between the fixed coupling winding wheel 28 and the follower bracket 26. The follower pulley block 27 is fixed on the follower bracket 26, the follower gear 22 is connected to the follower bracket 26 via a plug screw, the follower gear 22 and the plug screw are connected via a flange bearing, and the follower gear can rotate around the plug screw.

[0083] Further, refer to Figure 4 The driving gear, the follower gear, and the fixed gear form a planetary gear train, forming a differential gear set. When rotating, the follower gear rotates around the transmission shaft Rotate.

[0084] Further, refer to Figure 4 , the first decoupling mechanism 3 also includes an elbow drive rope 412, the elbow drive rope 412 passes through the shoulder coupling winding wheel 25, the follower pulley set 27, and the fixed coupling winding wheel 28 in sequence, and the elbow drive rope 412 can achieve that the elbow rope length remains unchanged when the shoulder three-swivel joint 203 moves;

[0085] The elbow driving rope 412 and the third shoulder driving rope can realize the decoupling of the shoulder second pitch joint 202, the shoulder third rotation joint 203 and the elbow joint 5 through the first pulley group and the second pulley group of the second decoupling mechanism 8.

[0086] Further, refer to Figure 1 and Figure 2The second decoupling mechanism 8 includes a base guide pulley 31, a base coupling wire wheel 32, a base reversing pulley 33, a first movable pulley set 34, a second movable pulley set 35, a first shoulder transmission shaft 36, a first shoulder coupling wheel 37, a linear guide rail 38 and a slider 39;

[0087] When the shoulder 1 swivel joint 201 moves, the shoulder 1 joint coupling rope 415 drives the first movable pulley group to make a linear motion. When the shoulder 2 pitch joint 202 moves, the shoulder 2 joint coupling rope 414 drives the second movable pulley group to make a linear motion, so that the coupling rope length in the second decoupling mechanism 8 remains unchanged.

[0088] Decoupling principle of shoulder triple swivel joint 203:

[0089] The driving source rotates, the opening and closing line unit pulls the opening and closing line, and the contraction line unit pulls the contraction line; the opening and closing line and the contraction line produce opposite displacement changes to generate a torque difference at the shoulder three-swivel joint 203, and based on the torque difference, the shoulder three-swivel joint 203 is rotated at a speed Rotate, drive gear 21, follow shoulder three swivel joint 203 to The fixed gear angular velocity is 0, so the follower gear 22 is in meshing relationship. The elbow drive rope 412 passes through the shoulder coupling reel 25, the follower pulley set 27, and the fixed coupling reel 28 in sequence, and the first decoupling mechanism 3 is used to decouple the rope of the elbow joint 5 in the rotation direction.

[0090] The second decoupling mechanism 8 includes a base guide pulley 31, a base coupling wire wheel 32, a base reversing pulley 33, a first movable pulley group 34, a second movable pulley group 35, a first shoulder transmission shaft 36, a first shoulder coupling wheel 37, a shoulder joint coupling rope 415, and a shoulder joint coupling rope 414. The base guide pulley 31 is fixed on the rotating bracket, the upper end of the rotating bracket is fixed to the shoulder rotary joint 201 by screws, the shoulder rotary joint 201 is connected to the first shoulder transmission shaft 36, and the first shoulder coupling wheel 37 is fixed to the output end of the first shoulder transmission shaft 36 and can rotate with the transmission shaft. The first shoulder coupling wheel 37 is connected to the lower end of the rotating bracket by screws to increase the rigidity of the rotating bracket. The first shoulder transmission shaft 36 is connected to multiple base coupling wire wheels 32 through bearings, which are used to couple the movement of the rear end drive rope and the first shoulder joint, and the base reversing pulley 33 is fixed on the base. The first movable pulley set 34 and the second movable pulley set 35 are installed on the linear guide rail through sliders. The linear guide rail and the base are fixed by screws. The first movable pulley set 34 and the second movable pulley set 35 can independently perform reciprocating linear motion along the linear guide rail.

[0091] The first movable pulley group 34 and the second movable pulley group 35 are fixed on the pulley bracket, and the base coupling pulley 32, the base reversing pulley 33, the first movable pulley group 34, and the second movable pulley group 35 can have multiple (unlimited) pulleys.

[0092] The driving sources 9 of the shoulders and elbows are fixed to the fixed base 1 of the robot arm, which reduces the mass of the movable part of the robot arm and improves the load-to-weight ratio of the robot arm.

[0093] The wrist driving source 9 is fixed at the end of the first arm 4 and the wrist joint 7 to reduce the inertia of the robot arm and simplify the structure.

[0094] The second decoupling mechanism 8 can realize the drive decoupling of the first shoulder joint and the second shoulder joint. The decoupling principle of the second decoupling mechanism 8 is as follows:

[0095] The decoupling principle of the shoulder-swivel joint 201 is as follows: the first shoulder driving source rotates, the opening-closing line unit pulls the opening-closing line, and the contraction line unit pulls the contraction line; the opening-closing line and the contraction line produce opposite displacement changes, and a torque difference is generated in the shoulder-swivel joint 201. Based on the torque difference, the shoulder-swivel joint 201 rotates at a speed of Rotation, the first shoulder coupling wheel 37 follows the shoulder-swivel joint 201 to The rope rotates at a speed of , driving the first movable pulley group 34 to The decoupling rope moves at a linear speed. Since the decoupling rope passes through two sections on the first movable pulley block 34, the rope length changes to The shoulder joint coupling rope 414, shoulder joint driving rope 412 and elbow driving rope 412 have the same motion state as the shoulder joint coupling rope 415 through the base coupling wire wheel 32 and the first movable pulley 34, so that the shoulder joint coupling rope 414, shoulder joint driving rope 412 and elbow driving rope 412 remain unchanged in length during the joint movement. The decoupling of the driving ropes of each joint in the rotation direction is achieved through the second decoupling mechanism 8.

[0096] Decoupling principle of the shoulder second pitch joint 202: the driving source of the shoulder second pitch joint 202 rotates, the opening and closing line unit pulls the opening and closing line, and the contraction line unit pulls the contraction line; the opening and closing line and the contraction line produce opposite displacement changes, a tension difference is generated in the second pulley group, and the second pulley is driven to move at a speed of v based on the tension difference. The linear movement of the second pulley group causes the shoulder second coupling rope to produce opposite displacement changes, a torque difference is generated in the shoulder second rotary joint, and based on the torque difference, the shoulder second rotary joint is driven to rotate at a speed of v. Rotation, since the shoulder-two coupling rope goes around the second movable pulley for a section, the rope length changes to 2v, and the shoulder-two coupling rope changes to , the rope length changes equally, so it satisfies r is the radius of the winding wheel of shoulder 2. Since the shoulder 3 joint drive rope 413 and the rear end joint drive rope are wound around the second movable pulley for two sections, the rope length changes to The length of the shoulder joint driving rope 413 and the rear end joint driving rope at the shoulder joint 2 pitch joint 202 changes to The shoulder 2 decoupling rope, shoulder 3 driving rope, and rear joint driving rope pass through the base coupling pulley and the first movable pulley, and have the same motion state as the shoulder 2 decoupling rope, so that the shoulder 2 decoupling rope, shoulder 3 driving rope, and rear joint driving rope remain unchanged during the joint movement. The base decoupling mechanism realizes the decoupling of each joint driving rope in the rotation direction.

[0097] One end of the shoulder driving rope is fixed on the first shoulder driving winding wheel, and the other end is fixed on the first motor winding wheel. The shoulder driving rope is composed of an opening and closing line and a contraction line, and the opening and closing line and the contraction line are wound in opposite directions.

[0098] The fixed end of the shoulder-to-coupling rope is fixed on the shoulder-to-coupling wheel, and the movable end passes through the first base reversing pulley and the first movable pulley in sequence and is fixed on the fixed base. The shoulder-to-coupling rope is composed of an opening and closing line and a contraction line, and the opening and closing line and the contraction line pass through the first base reversing pulley and the first movable pulley in opposite winding directions.

[0099] One end of the shoulder two coupling rope is fixed on the shoulder two fixed bracket, and the opening and closing line and the contraction line pass around the shoulder two winding wheel in reverse through a set of tension amplification mechanisms, which can drive the shoulder two joint to rotate forward and reverse. The output end passes through the second base guide wheel, the second base reversing pulley, the first movable pulley, and the second movable pulley in turn, and is fixed on the fixed base.

[0100] One end of the driving rope of the shoulder second pitch joint 202 is fixed to the second movable pulley group, and is sequentially passed through the driving guide pulley and wound onto the second motor winding wheel in the opposite direction.

[0101] One end of the driving rope of the shoulder three rotating joint 203 is fixed on the shoulder three driving winding wheel, and passes through the shoulder three guide pulley, the shoulder three decoupling mechanism pulley group, the shoulder two winding wheel, the third base guide wheel, the third base reversing wheel, the first movable pulley, the second movable pulley, bypasses the driving guide wheel, and is wound on the third motor winding wheel in the opposite direction.

[0102] One end of the elbow drive rope 412 is fixed on the rear end drive winding wheel, and passes through the rear end joint guide pulley, the shoulder three decoupling mechanism pulley group, the shoulder two winding wheel, the third base guide wheel, the third base reversing wheel, the first movable pulley, the second movable pulley, bypasses the drive guide wheel, and is wound on the fourth motor winding wheel in the opposite direction.

[0103] The wrist drive rope is wound onto the fifth / sixth motor reel in the opposite direction via elbow decoupling.

[0104] The above is only a preferred embodiment of the present invention. The present invention is not limited to the above implementation. As long as the technical effect of the present invention is achieved by the same means, any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present disclosure shall be included in the scope of protection of the present disclosure. All should belong to the protection scope of the present invention. Within the protection scope of the present invention, its technical scheme and / or implementation method can have various modifications and changes.

Claims

1. A rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator, characterized in that: include: A fixed base (1), a shoulder joint (2), a first decoupling mechanism (3), a first arm (4), an elbow joint (5), a second arm (6) and a wrist joint (7) connected in sequence; The shoulder joint (2) has three degrees of freedom, and comprises a shoulder first swivel joint (201), a shoulder second pitch joint (202), and a shoulder third swivel joint (203); the shoulder first swivel joint (201) is connected to the fixed base (1); The first decoupling mechanism (3) has one rotational degree of freedom, the first decoupling mechanism (3) is connected between the shoulder second pitch joint (202) and the shoulder third rotation joint (203) of the shoulder joint (2), and the first decoupling mechanism (3) is used to decouple the rear end rope; The elbow joint (5) has one degree of freedom, and the end of the first arm (4) and the starting end of the second arm (6) are respectively connected to the elbow joint (5); The wrist joint (7) has three degrees of freedom, and the wrist joint (7) is connected to the end of the second arm (6); A second decoupling mechanism (8) is provided on the fixed base (1), the second decoupling mechanism (8) has two degrees of freedom, and the second decoupling mechanism (8) is connected between the fixed base (1) and the shoulder joint (2); It also includes a driving source (9), the driving source (9) including a first driving source (91), a second driving source (92), a third driving source (93), a fourth driving source (94), a fifth driving source (95), a sixth driving source (96), and a seventh driving source (97); The first driving source (91), the second driving source (92) and the third driving source (93) are arranged on the fixed base (1), and the first driving source (91), the second driving source (92) and the third driving source (93) are used to drive the shoulder joint (2) to move; The fourth driving source (94) is arranged on the fixed base (1), and the fourth driving source (94) is used to drive the elbow joint (5) to move; The fifth driving source (95) and the sixth driving source (96) are arranged on the first arm (4), and the seventh driving source (97) is arranged on the wrist joint bracket, and the fifth driving source (95), the sixth driving source (96) and the seventh driving source (97) are used to drive the wrist joint (7) to move; The elbow joint (5) comprises a first driving wire reel (501), a second driving wire reel (502), a coupling wire reel (503), a coupling driving rope (504), a decoupling wire reel (505), an elbow joint bracket (506), an elbow joint connecting rod (507) and an elbow rotating shaft (508). The coupling drive rope (504) is wound in the shape of an "8", and the driving source drives the elbow joint (5) to generate pure rolling motion via the transmission rope, thereby driving the second arm (6) to move relative to the first arm (4), and the rope length of the elbow joint (5) remains unchanged, thereby achieving decoupling of the wrist joint drive rope (411); The first decoupling mechanism (3) comprises a driving gear (21), a follower gear (22), a fixed gear (23), a transmission shaft (24), a shoulder coupling winding wheel (25), a follower bracket (26), a follower pulley group (27), and a fixed coupling winding wheel (28); The driving gear is connected to the shoulder three swivel joint (203) via the transmission shaft, the shoulder coupling winding wheel is connected to the transmission shaft via a bearing, the follower gear is connected and fixed to the follower bracket via a bearing, the follower bracket is connected to the transmission shaft via a bearing, the follower pulley group is fixed to the follower bracket, the follower pulley group rotates around the transmission shaft, the fixed gear and the fixed coupling winding wheel are fixed to the shoulder two pitch joint (202), and the fixed coupling winding wheel is connected to the transmission shaft via a bearing.

2. The rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator according to claim 1, characterized in that: The driving sources (9) are connected to the driven joints through corresponding driving ropes. The driving sources (9) are connected to joint driving wheels. The joint driving wheels are arranged with spiral lines to prevent the driving ropes from falling off. The driving ropes include an opening and closing rope and a contraction rope. The opening and closing rope and the contraction rope are respectively located on both sides of the joint driving wheel.

3. The rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator according to claim 2, characterized in that: The opening and closing rope and the contraction rope are wound around the joint driving wheel, and the winding directions of the opening and closing rope and the contraction rope on the joint driving wheel are opposite.

4. The rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator according to claim 1, characterized in that: The wrist joint (7) comprises a differential transmission wheel (701), a wrist bracket (702), a first drive wheel (703), a second drive wheel (704), a universal transmission shaft (705), a wrist joint differential rope (410), and a wrist joint drive rope (411); The first wrist joint and the second wrist joint are driven in parallel with differential speed, and the third wrist joint transmits rotary motion through the universal transmission shaft.

5. The rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator according to claim 1, characterized in that: The driving gear, the follower gear and the fixed gear form a planetary gear train, forming a differential gear set. When rotating, the follower gear rotates around the transmission shaft Rotate.

6. The rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator according to claim 1, characterized in that: The first decoupling mechanism (3) further comprises an elbow drive rope (412), wherein the elbow drive rope (412) passes through the shoulder coupling winding wheel (25), the follower pulley group (27), and the fixed coupling winding wheel (28) in sequence, and the elbow drive rope (412) can achieve that the elbow rope length remains unchanged when the shoulder three-revolving joint (203) moves; The elbow driving rope (412) and the shoulder three joint driving rope (413) are capable of decoupling the shoulder two pitch joint (202), the shoulder three swivel joint (203) and the elbow joint (5) through the first movable pulley group (34) and the second movable pulley group (35) of the second decoupling mechanism (8).

7. The rope-driven, high-load-ratio, seven-DOF anthropomorphic agile manipulator according to claim 1, characterized in that: The second decoupling mechanism (8) comprises a base guide pulley (31), a base coupling wire wheel (32), a base reversing pulley (33), a first movable pulley group (34), a second movable pulley group (35), a first shoulder transmission shaft (36), a first shoulder coupling wheel (37), a linear guide rail (38) and a slider (39); When the shoulder first swivel joint (201) moves, the shoulder first joint coupling rope (415) drives the first movable pulley group to perform linear motion, and when the shoulder second pitch joint (202) moves, the shoulder second joint coupling rope (414) drives the second movable pulley group to perform linear motion, thereby achieving a constant length of the coupling rope in the second decoupling mechanism (8).

Citation Information

Patent Citations

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

    CN110666833A

  • Rope-driven mechanical arm

    CN117245636A