Rope-driven passive decoupling three-degree-of-freedom series shoulder joint
By using the base decoupling mechanism and the slewing joint decoupling structure in the rope drive joint, the shoulder and rear end joint drive motors are placed on the fixed base, which solves the problem of rope drive joint coupling and reduces the weight of the robotic arm and Inertia expands the range of movement and meets the agile robotic arm's agility requirements.
Patent Information
- Application Number
- CN202411343833.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-25
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2044-09-25
AI Technical Summary
There are coupling problems when existing rope drive joints are moved, resulting in increased size and mass of the robotic arm, making it difficult to meet the agile robotic arm’s dexterity requirements, especially in the three-degree of freedom series shoulder joint, the motor is located at the movable end, the moment of inertia and mass Large, and small range of movement.
A rope-driven passive decoupling three-degree of freedom series shoulder joint is designed, using base decoupling mechanism and slewing joint decoupling structure, and the shoulder and rear end joint drive motor are placed on the fixed base and passed through cross roller bearings. , winding wheels and pulley sets realize the decoupling of the rope, reduce the weight and moment of inertia of the robotic arm, and simplify the structure through planetary gear trains and pulley sets.
Without increasing the size of the moving part of the robot arm, the decoupling of the tandem multi-joint rope is achieved, which reduces the mass and inertia of the shoulder joint, expands the range of movement, meets the agile robotic arms, and adjusts The number of decoupling wheels enables mechanical decoupling of multiple back end joints.
Smart Images

Figure CN118906085A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of mechanical arms, and in particular to a rope-driven passively decoupled three-degree-of-freedom series shoulder joint and a control method thereof. Background Art
[0002] The coupling of the rope-driven joint is that when the front joint moves, the rope of the rear joint passes through the front joint, causing the length of the rope to change accordingly, affecting the control of the rear joint. To address the coupling problem of the rope-driven joint, a decoupling mechanism can be used to eliminate the motion coupling between the front joint and the rear joint. At present, most passive decoupling mechanisms are only suitable for single-rotation joint rope decoupling. For a series of multi-joint structures, a decoupling mechanism needs to be added at each joint coupling, which increases the size and mass of the active part of the robot arm, making it difficult to meet the dexterity requirements of an agile robot arm.
[0003] The three-degree-of-freedom serial shoulder joint of the robotic arm generally adopts a direct connection method of a motor plus a harmonic reducer. The motor is still located at the active end of the robotic arm, and the inertia and mass of the joint are large. Although the multi-degree-of-freedom parallel shoulder joint places the motor on the base, the joint generally has a small range of motion and has singularities, which leads to a reduction in the working space of the robotic arm. Summary of the invention
[0004] The present invention provides a rope-driven passively decoupled three-degree-of-freedom series shoulder joint 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 passively decoupled three-degree-of-freedom series shoulder joint, comprising: A fixed base, wherein a base decoupling mechanism is provided on the fixed base; A shoulder-swivel joint, the shoulder-swivel joint is arranged above the fixed base, the shoulder-swivel joint comprises a shoulder-rotor, a shoulder stator, and a first cross roller bearing, the shoulder-swivel joint is connected to a shoulder-swivel shaft via a shoulder-rotor, the base decoupling mechanism is arranged between the shoulder-swivel joint and the fixed base, and the base decoupling mechanism is connected to the shoulder-swivel joint via the shoulder-swivel shaft; Shoulder 2 pitch joint, the shoulder 2 pitch joint is arranged above the shoulder 1 swivel joint and connected to the shoulder 1 rotor, the shoulder 2 pitch joint comprises a shoulder 2 stator, a shoulder 2 rotor, a shoulder 2 fixed shaft, a shoulder 2 winding wheel, and a shoulder 2 coupling wheel, the shoulder 2 stator is fixedly connected to the shoulder 1 rotor via a connecting piece, the shoulder 2 fixed shaft is fixedly connected to the shoulder 2 stator, the shoulder 2 winding wheel is fixed on the shoulder 2 rotor, and is arranged on both sides of the shoulder 2 fixed shaft; The shoulder three rotary joint is arranged above the shoulder two pitch joint and connected to the shoulder two rotor. The shoulder three rotary joint includes a shoulder three upper stator, a shoulder three rotor, a shoulder three winding wheel, a second cross roller bearing, and a shoulder three rotary decoupling mechanism. The shoulder three rotary shaft is arranged in the shoulder three rotor. The shoulder three rotary decoupling mechanism is connected to the shoulder three rotary joint through the shoulder three rotary shaft.
[0006] Furthermore, the three-degree-of-freedom joint also includes a rear end joint driving rope, a shoulder three joint driving rope, a shoulder two joint coupling rope, a shoulder one joint driving rope, a shoulder one joint coupling rope and a shoulder two joint driving rope; The shoulder-joint driving rope is connected to the shoulder-rotor through the shoulder-swivel joint, and the shoulder-joint driving rope is used to drive the shoulder-reel to rotate; One end of the shoulder-joint coupling rope is fixed to the shoulder-coupling wheel, and the other end is fixed to the fixed base; The shoulder joint coupling rope is connected to the fixed base through the shoulder swivel joint and the base decoupling mechanism in sequence; One end of the shoulder joint driving rope is connected to the base decoupling mechanism, and the other end is connected to the second motor winding wheel; One end of the shoulder three joint driving rope is fixed to the shoulder three rotor, and the other end is connected to the third motor winding wheel through the shoulder two pitch joint, the shoulder one swivel joint, and the base decoupling mechanism in sequence; One end of the rear end joint driving rope is fixed on the rear end movable joint, and the other end is connected to the motor winding wheel through the shoulder three rotation decoupling mechanism, the shoulder two pitch joint, the shoulder one rotation joint and the base decoupling mechanism in sequence.
[0007] Furthermore, the shoulder one winding wheel, shoulder two winding wheel, shoulder three winding wheel and rear end movable joint are driven by the torque difference generated by the shoulder one joint driving rope, the shoulder two joint driving rope, the shoulder three joint driving rope and the rear end joint driving rope.
[0008] Further, the shoulder three rotor is connected to the inner ring of the second cross roller bearing, and the outer ring of the cross roller bearing is connected to the shoulder three upper stator; The shoulder 2 coupling wheel is connected to the shoulder 2 fixed shaft via a first deep groove ball bearing, and the shoulder 2 first winding wheel and the shoulder 2 second winding wheel are connected to the shoulder 2 fixed shaft via a second deep groove ball bearing respectively; The shoulder rotor is connected to the fixed base through the inner ring of the first cross roller bearing, and the outer ring of the cross roller bearing is fixed on the fixed base.
[0009] Furthermore, the shoulder three-revolving joint includes a shoulder three-revolving axis, an active coupling wheel, a follower decoupling wheel group, a driving gear, a follower gear, a fixed gear, a follower bracket, a fixed coupling wheel, a shoulder three winding wheel, and a shoulder three guide pulley.
[0010] The driving gear, the follower gear and the fixed gear form a planetary gear train, forming a differential motion mechanism; The shoulder three winding wheel transmits the motion to the shoulder three rotation decoupling mechanism through the shoulder three rotating shaft, driving the driving gear to move. The driving gear and the shoulder three rotating shaft have the same rotation speed, and the follower gear is respectively meshed with the driving gear and the fixed gear, and the fixed gear is fixedly connected to the shoulder two pitch joint.
[0011] Furthermore, the base decoupling mechanism includes a base coupling pulley, a first base reversing pulley, a first movable pulley group, a second movable pulley group, a shoulder-coupling wheel, a shoulder-rotating shaft, a shoulder-guide pulley, a linear guide rail and a slider.
[0012] The shoulder-swivel joint is connected to the shoulder-swivel shaft via a shoulder-rotor, the shoulder-coupling wheel is fixed to the output end of the shoulder-swivel shaft, and the shoulder-swivel joint, the shoulder-swivel shaft and the shoulder-coupling wheel rotate at the same angular velocity; One end of the shoulder-joint driving rope is fixed on the shoulder-joint driving winding wheel, the shoulder-joint driving rope is wound in a closed loop in the same direction, the other end of the shoulder-joint driving rope is fixed on the first motor winding wheel, and the shoulder-joint driving rope is composed of an opening and closing line and a contraction line with opposite winding directions; The fixed end of the shoulder-joint coupling rope is fixed on the shoulder-coupling wheel, and the movable end of the shoulder-joint coupling rope is fixed on the fixed base after passing through the first base reversing pulley and the first movable pulley group in sequence. The shoulder-joint coupling rope consists of an opening and closing line and a contraction line, and the opening and closing line and the contraction line have opposite winding directions through the first base reversing pulley and the first movable pulley group.
[0013] Further, one end of the shoulder joint coupling rope is fixed on the shoulder trochanter, the opening and closing line and the contraction line of the shoulder joint coupling rope are reversely bypassed by the shoulder trochanter, driving the shoulder trochanter to rotate forward and reversely, and the output end of the shoulder joint coupling rope is fixed on the fixed base after passing through the base coupling pulley, the base reversing pulley, the first movable pulley group and the second movable pulley group in sequence; One end of the shoulder joint driving rope is fixed on the movable pulley set, and the shoulder joint driving rope passes through the driving guide pulley in turn, and the shoulder joint driving rope is wound around the second motor winding wheel in the opposite direction.
[0014] Furthermore, one end of the shoulder three-joint driving rope is fixed on the shoulder three rotor. The shoulder three-joint driving rope passes through the shoulder three guide pulley, the shoulder two winding wheel, the base coupling wheel, the base reversing wheel, the first movable pulley group and the second movable pulley group in sequence, then bypasses the driving guide wheel and is wound onto the third motor winding wheel in the opposite direction.
[0015] Furthermore, one end of the rear end joint driving rope is fixed on the rear end joint, and the rear end joint driving rope passes through the rear end guide pulley, the active coupling wheel, the follow-up decoupling pulley group, the fixed coupling wheel, the shoulder second winding wheel, the base coupling wheel, the base reversing wheel, the first movable pulley group, and the second movable pulley group in sequence, and then bypasses the driving guide wheel, and the rear end joint driving rope is wound around the fourth motor winding wheel in the opposite direction.
[0016] Furthermore, the first movable pulley group and the second movable pulley group are mounted on a slider, the slider is mounted on a linear guide rail, and the slider can reciprocate along the linear guide rail. The linear guide rail is arranged on the fixed base.
[0017] The beneficial effects of the present invention are: The rope-driven passive decoupling three-degree-of-freedom series shoulder joint can achieve the decoupling of the series multi-joint ropes without increasing the size of the active part of the robot arm, and place the shoulder and rear-end joint drive motors on a fixed base to reduce the weight and inertia of the robot arm, meeting the dexterity requirements of the agile robot arm. Specifically, a series rotary joint decoupling structure is adopted, which can complete the decoupling of the series multi-joint ropes without increasing the size of the active joints of the robot arm. The shoulder drive motor is placed on a fixed base at the rear, and the active part of the shoulder joint weighs only 2kg, which reduces the mass and inertia of the shoulder joint activity, simplifies the structure of the three-degree-of-freedom series shoulder joint, and at the same time, retains the design of the series joint, so that the shoulder joint can achieve a larger range of motion and flexibility, meeting the dexterity requirements of the agile robot arm. The rope-driven shoulder joint can achieve the decoupling of the rear-end joint rope, and the mechanical decoupling of multiple rear-end joints can be achieved by adjusting the number of decoupling wheels. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] Figure 1 This is the overall structure diagram of the rope-driven passively decoupled three-degree-of-freedom series shoulder joint.
[0019] Figure 2 This is the structural diagram of the shoulder 2 pitch joint and shoulder 3 rotation joint of the rope-driven passive decoupling three-degree-of-freedom series shoulder joint.
[0020] Figure 3 This is the structural diagram of the shoulder three-revolving joint decoupling mechanism in the rope-driven passive decoupling three-degree-of-freedom series shoulder joint.
[0021] Figure 4This is a cross-sectional view of the rope-driven passive decoupling three-degree-of-freedom series shoulder joint mechanism with two pitch joints and three swivel joints. Figure 5 This is the structural diagram of the base decoupling mechanism of the rope-driven passively decoupled three-degree-of-freedom series shoulder joint.
[0022] Figure 6 Cross-sectional view of the base decoupling mechanism of the rope-driven passively decoupled three-DOF serial shoulder joint.
[0023] Figure 7 Schematic diagram of the winding of the rope-driven passively decoupled three-degree-of-freedom series shoulder joint.
[0024] 1. Base decoupling mechanism; 2. Shoulder 1 swivel joint; 3. Shoulder 2 pitch joint; 4. Shoulder 3 swivel joint; 5. First motor winding wheel; 6. Second motor winding wheel; 7. Fixed base; 8. Rear end joint driving rope; 9. Shoulder 3 joint driving rope; 10. Shoulder 2 joint coupling rope; 11. Shoulder 1 joint coupling rope; 12. Shoulder 1 joint driving rope; 13. Shoulder 2 joint driving rope; 14. Driving motor; 201. Shoulder 1 rotor; 202. Shoulder stator; 203. First cross roller bearing; 204. Shoulder 2 stator; 205. Shoulder 2 rotor; 206. Shoulder 2 fixed shaft; 207. Shoulder 2 winding wheel; 208. Shoulder 3 upper stator; 20 9. Shoulder three rotor; 210. Shoulder three winding wheel; 211. Second cross roller bearing; 212. Shoulder three rotary decoupling mechanism; 213. Shoulder one winding wheel; 31. Driving gear; 32. Follower gear; 33. Fixed gear; 34. Driving shaft; 35. Active coupling wheel; 36. Follower bracket; 37. Follower decoupling wheel group; 38. Fixed coupling wheel; 40. Shoulder three guide pulley; 41. Rear end guide pulley; 51. Base coupling pulley; 52. Base reversing pulley; 53. First movable pulley group; 54. Second movable pulley group; 55. Shoulder one coupling wheel; 56. Shoulder one rotary shaft; 57. Shoulder one guide pulley; 58. Linear guide rail; 59. Slider. DETAILED DESCRIPTION
[0025] 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.
[0026] 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.
[0027] 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.
[0028] 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.
[0029] Reference Figures 1 to 7 In some embodiments, the technical solution of the present invention is a rope-driven passive decoupled three-degree-of-freedom series shoulder joint, referring to Figure 1 and Figure 2 The rope-driven passive decoupling three-degree-of-freedom series shoulder joint comprises: A fixed base 7, on which a base decoupling mechanism 1 is provided; A shoulder-swivel joint 2, wherein the shoulder-swivel joint 2 is arranged above the fixed base 7, the shoulder-swivel joint 2 comprises a shoulder-rotor 201, a shoulder stator 202, and a first cross roller bearing 203, the shoulder-swivel joint 2 is connected to a shoulder-swivel shaft 56 via the shoulder-rotor 201, the base decoupling mechanism 1 is arranged between the shoulder-swivel joint 2 and the fixed base 7, and the base decoupling mechanism 1 is connected to the shoulder-swivel joint 2 via the shoulder-swivel shaft 56; Shoulder 2 pitch joint 3, the shoulder 2 pitch joint is arranged above the shoulder 1 swivel joint 2 and connected to the shoulder 1 rotor 201, the shoulder 2 pitch joint 3 includes a shoulder 2 stator 204, a shoulder 2 rotor 205, a shoulder 2 fixed shaft 206, a shoulder 2 winding wheel 207, and a shoulder 2 coupling wheel, the shoulder 2 stator 204 is fixedly connected to the shoulder 1 rotor 201 through a connecting piece, the shoulder 2 fixed shaft 206 is fixedly connected to the shoulder 2 stator 204, the shoulder 2 winding wheel 207 is fixed on the shoulder 2 rotor 205, and is arranged on both sides of the shoulder 2 fixed shaft 206; The shoulder three rotation joint 4 is arranged above the shoulder two pitch joint 3 and connected to the shoulder two rotor 205. The shoulder three rotation joint 4 includes a shoulder three upper stator 208, a shoulder three rotor 209, a shoulder three winding wheel 210, a second cross roller bearing 211, and a shoulder three rotation decoupling mechanism 212. The shoulder three rotation shaft 34 is arranged in the shoulder three rotor 209. The shoulder three rotation decoupling mechanism 212 is connected to the shoulder three rotation joint 4 through the shoulder three rotation shaft 34.
[0030] The beneficial effects of the present invention are: The rope-driven passive decoupling three-degree-of-freedom series shoulder joint can achieve the decoupling of the series multi-joint ropes without increasing the size of the active part of the robot arm. The shoulder and rear end joint drive motors are placed on the fixed base 7, which reduces the weight and inertia of the robot arm and meets the dexterity requirements of the agile robot arm. Specifically, a series rotary joint decoupling structure is adopted, which can complete the decoupling of the series multi-joint ropes without increasing the size of the active joints of the robot arm. The shoulder drive motor is placed on the fixed base 7, and the active part of the shoulder joint is only 2kg, which reduces the mass and inertia of the shoulder joint activity, simplifies the structure of the three-degree-of-freedom series shoulder joint, and at the same time, retains the design of the series joint, so that the shoulder joint can achieve a larger range of motion and flexibility, meeting the dexterity requirements of the agile robot arm. The rope-driven shoulder joint can achieve the decoupling of the rear end joint rope, and the mechanical decoupling of multiple rear end joints can be achieved by adjusting the number of decoupling wheels.
[0031] The present invention provides a rope-driven passively decoupled three-degree-of-freedom series shoulder joint mechanism, which can achieve decoupling of series multi-joint ropes without increasing the size of the active part of the robot arm, place the shoulder and rear end joint drive motors on a fixed base 7, reduce the weight and inertia of the robot arm, and meet the dexterity requirements of the agile robot arm.
[0032] Further, refer to Figure 3 The three-degree-of-freedom joint also includes a rear end joint driving rope 8, a shoulder three joint driving rope 9, a shoulder two joint coupling rope 10, a shoulder one joint driving rope 11, a shoulder one joint coupling rope 12 and a shoulder two joint driving rope 13; The shoulder-joint driving rope 11 is connected to the shoulder-rotor 201 through the shoulder-swivel joint 2, and the shoulder-joint driving rope 11 is used to drive the shoulder-winding wheel 213 to rotate; The shoulder joint coupling rope 10 is connected to the fixed base 7 through the shoulder swivel joint 2 and the base decoupling mechanism 1 in sequence; One end of the shoulder joint driving rope 13 is connected to the base decoupling mechanism 1, and the other end is connected to the second motor winding wheel 6; One end of the shoulder three joint driving rope 9 is fixed to the shoulder three rotor 209, and the other end is connected to the third motor winding wheel through the shoulder two pitch joint 3, the shoulder one swivel joint 2, and the base decoupling mechanism 1 in sequence; One end of the rear end joint driving rope 8 is fixed on the rear end movable joint, and the other end is connected to the motor winding wheel 5 through the shoulder three rotation decoupling mechanism 212, the shoulder two pitch joint 3, the shoulder one rotation joint 2 and the base decoupling mechanism 1 in sequence.
[0033] Specifically, the driving rope includes an opening and closing rope and a contraction rope, which are respectively located on both sides of the joint driving wheel, are wound around the joint driving wheel, and are wound in opposite directions on the joint driving wheel.
[0034] The decoupling mechanism can ensure that the length of the rope passing through the decoupling mechanism remains unchanged, thereby achieving decoupling of the joint.
[0035] Further, refer to Figure 5 , 6 The shoulder one winding wheel 213, the shoulder two winding wheel 207, the shoulder three winding wheel 210 and the rear end movable joint are driven by the torque difference generated by the shoulder one joint driving rope 11, the shoulder two joint driving rope 13, the shoulder three joint driving rope 9 and the rear end joint driving rope 8.
[0036] Further, the shoulder three rotor 209 is connected to the inner ring of the second cross roller bearing 211, and the outer ring of the second cross roller bearing 211 is connected to the shoulder three upper stator 208; The shoulder 2 coupling wheel is connected to the shoulder 2 fixed shaft 206 via a first deep groove ball bearing 214, and the shoulder 2 first winding wheel 207 and the shoulder 2 second winding wheel 207 are connected to the shoulder 2 fixed shaft 206 via a second deep groove ball bearing 216 respectively; The shoulder rotor 201 is connected to the fixed base 7 via the inner ring of the first cross roller bearing 203 , and the outer ring of the cross roller bearing 215 is fixed on the fixed base 7 .
[0037] Furthermore, the shoulder three-swivel joint 4 includes a shoulder three-swivel axis 34, an active coupling wheel 35, a follower decoupling wheel group 37, a driving gear 31, a follower gear 32, a fixed gear 33, a follower bracket 36, a fixed coupling wheel 38, a shoulder three winding wheel 210, and a shoulder three guide pulley 40.
[0038] The driving gear 31, the follower gear 32 and the fixed gear 33 form a planetary gear train, forming a differential motion mechanism; The shoulder three winding wheel 210 transmits the motion to the shoulder three rotation decoupling mechanism through the shoulder three rotating shaft 34, driving the driving gear 31 to move. The driving gear 31 and the shoulder three rotating shaft 34 have the same rotation speed, and the follower gear 32 is respectively meshed with the driving gear 31 and the fixed gear 33, and the fixed gear 33 is fixedly connected to the shoulder two pitch joint 3.
[0039] Specifically, the decoupling principle of the three shoulder joints: The servo motor of the opening and closing line unit rotates, and the opening and closing line unit pulls the opening and closing line; the servo motor of the contraction line unit rotates, 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 in the shoulder three-swivel joint 6, and based on the torque difference, the shoulder three-swivel joint 6 rotates at a speed Rotate, drive gear 31, follow shoulder three rotation joint 6 to The fixed gear 38 rotates at a speed of 0, so the follower decoupling wheel set 37 is in a meshing relationship. The active coupling wheel 35 is fixed on the shoulder three rotating shaft 6, the fixed coupling wheel 38 and the shoulder three rotating shaft 6 are connected through bearings, and the follower decoupling wheel set 37 is fixed on the follower gear 32 and rotates at the same speed. The rear end joint drive rope 14 passes through the active coupling wheel 35, the follower decoupling wheel set 37, and the fixed coupling wheel 38 in sequence, and the rear end drive joint rope is decoupled in the rotation direction through the decoupling mechanism.
[0040] Furthermore, the base decoupling mechanism 1 includes a base coupling pulley 51, a first base reversing pulley 52, a first movable pulley group 53, a second movable pulley group 54, a shoulder coupling wheel 55, a shoulder rotating shaft 56, a shoulder guide pulley 57, a linear guide rail 58 and a slider 59.
[0041] The shoulder-swivel joint 2 is connected to the shoulder-swivel shaft 56 through a shoulder-rotor 201, and the shoulder-coupling wheel 55 is fixed to the output end of the shoulder-swivel shaft 56. The shoulder-swivel joint 2, the shoulder-swivel shaft 56 and the shoulder-coupling wheel 55 rotate at the same angular velocity; One end of the shoulder-joint driving rope 11 is fixed on the shoulder-joint driving winding wheel 213, and the shoulder-joint driving rope 11 is wound in a closed loop in the same direction. The other end of the shoulder-joint driving rope 11 is fixed on the first motor winding wheel 5, and the shoulder-joint driving rope 11 is composed of an opening and closing line and a contraction line with opposite winding directions. The fixed end of the shoulder-joint coupling rope 12 is fixed on the shoulder-coupling wheel 55, and the movable end of the shoulder-joint coupling rope 12 is fixed on the fixed base 7 after passing through the first base reversing pulley 52 and the first movable pulley group 53 in sequence. The shoulder-joint coupling rope consists of an opening and closing line and a contraction line, and the opening and closing line and the contraction line have opposite winding directions through the first base reversing pulley 52 and the first movable pulley group 53.
[0042] Further, one end of the shoulder joint coupling rope 10 is fixed on the shoulder rotor 205, and the opening and closing line and the contraction line of the shoulder joint coupling rope 10 are reversely bypassed by the shoulder winding wheel 207 to drive the shoulder pitch joint 3 to rotate forward and reversely. The output end of the shoulder joint coupling rope 10 is fixed on the fixed base 7 after passing through the base coupling pulley 51, the base reversing pulley 52, the first movable pulley group 53 and the second movable pulley group 54 in sequence; One end of the shoulder joint driving rope 13 is fixed on the movable pulley set 53, and the shoulder joint driving rope 13 passes through the driving guide pulley 58 in turn, and the shoulder joint driving rope 13 is wound around the second motor winding wheel 6 in the opposite direction.
[0043] Furthermore, one end of the shoulder three-joint driving rope 13 is fixed on the shoulder three rotor 209. The shoulder three-joint driving rope 13 passes through the shoulder three guide pulley 40, the shoulder two winding wheel 207, the base coupling wheel 51, the base reversing wheel 52, the first movable pulley group 53 and the second movable pulley group 54 in sequence, then bypasses the driving guide wheel 58 and is wound onto the third motor winding wheel in the opposite direction.
[0044] Furthermore, one end of the rear end joint driving rope 8 is fixed on the rear end joint, and the rear end joint driving rope 8 passes through the rear end guide pulley 41, the active coupling wheel 35, the follow-up decoupling pulley group 37, the fixed coupling wheel 38, the shoulder second winding wheel 207, the base coupling wheel 51, the base reversing wheel 52, the first movable pulley group 53, and the second movable pulley group 54 in sequence, and then bypasses the driving guide wheel 58, and the rear end joint driving rope 8 is wound around the fourth motor winding wheel 5 in the opposite direction.
[0045] Decoupling principle of shoulder-swivel joint 2: The servo motor of the first motor winding wheel rotates, and the opening and closing line unit pulls the opening and closing line; the servo motor of the contraction line unit rotates, and the contraction line unit pulls the contraction line; the opening and closing line and the contraction line produce opposite displacement changes, and a torque difference is generated in the shoulder-swivel joint 2. Based on the torque difference, the shoulder-swivel joint 2 rotates at a speed Rotation, shoulder-coupling wheel follows shoulder-swivel joint 2 The rope rotates at a speed of , driving the first movable pulley group 53 to The decoupling rope moves at a linear speed. Since the decoupling rope passes through two sections on the first movable pulley block 53, the rope length changes to The shoulder 2 joint coupling rope, shoulder 3 driving rope, and rear joint driving rope pass through the base coupling pulley and the first movable pulley group 53, and have the same motion state as the shoulder 1 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.
[0046] Decoupling principle of shoulder II pitch joint: The servo motor of the second motor winding wheel 6 rotates, and the opening and closing line unit pulls the opening and closing line; the servo motor of the contraction line unit rotates, and the contraction line unit pulls the contraction line; the opening and closing line and the contraction line produce opposite displacement changes, and a tension difference is generated in the second pulley group. Based on the tension difference, the second pulley is driven to move at a speed of v. The linear movement of the second pulley group causes the shoulder second coupling rope to produce opposite displacement changes, and a torque difference is generated in the shoulder second rotary joint. Based on the torque difference, the shoulder second rotary joint is driven to rotate at a speed of v. Rotation, since the shoulder second coupling rope is passed around the second movable pulley set 54 for a section, the rope length changes to , the shoulder-to-shoulder 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 driving rope of shoulder 3 joint and the driving rope of rear end joint go around two sections on the second movable pulley set 54, the rope length changes to The length of the rope driven by the shoulder three joints and the rope driven by the rear end joint on the shoulder 2 winding wheel changes to The shoulder 2 decoupling rope, shoulder 3 driving rope, and rear joint driving rope have the same motion state as the shoulder 2 decoupling rope through the base coupling pulley and the first movable pulley group 53, 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 is used to achieve the decoupling of each joint driving rope in the rotation direction. The first pulley and the second pulley are fixed to the guide rail slider by screws, and the linear guide 58 is fixed to the base, and the guide rail slider can reciprocate along the guide rail.
[0047] Furthermore, the first movable pulley set 53 and the second movable pulley set 54 are mounted on a slider 59 , and the slider 59 is mounted on a linear guide rail 58 , and the slider 59 can reciprocate linearly along the linear guide rail 58 . The linear guide rail 58 is disposed on the fixed base 7 .
[0048] 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 passively decoupled three-degree-of-freedom series shoulder joint, characterized in that: include: A fixed base (7), wherein a base decoupling mechanism (1) is provided on the fixed base (7); A shoulder-swivel joint (2), the shoulder-swivel joint (2) being arranged above the fixed base (7), the shoulder-swivel joint (2) comprising a shoulder-rotor (201), a shoulder stator (202), and a first cross roller bearing (203), the shoulder-swivel joint (2) being connected to a shoulder-swivel shaft (56) via a shoulder-rotor (201), the base decoupling mechanism (1) being arranged between the shoulder-swivel joint (2) and the fixed base (7), the base decoupling mechanism (1) being connected to the shoulder-swivel joint (2) via the shoulder-swivel shaft (56); A shoulder-two pitch joint (3), the shoulder-two pitch joint (3) being arranged above the shoulder-one swivel joint (2) and connected to the shoulder-one rotor (201), the shoulder-two pitch joint (3) comprising a shoulder-two stator (204), a shoulder-two rotor (205), a shoulder-two fixed shaft (206), a shoulder-two winding wheel (207), and a shoulder-two coupling wheel, the shoulder-two stator (204) being fixedly connected to the shoulder-one rotor (201) via a connecting piece, the shoulder-two fixed shaft (206) being fixedly connected to the shoulder-two stator (204), and the shoulder-two winding wheel (207) being fixed on the shoulder-two rotor (205) and arranged on both sides of the shoulder-two fixed shaft (206); A shoulder-three revolving joint (4), wherein the shoulder-three revolving joint (4) is arranged above the shoulder-two pitching joint (3) and connected to the shoulder-two rotor (205), the shoulder-three revolving joint (4) comprises a shoulder-three upper stator (208), a shoulder-three rotor (209), a shoulder-three winding wheel (210), a second cross roller bearing (211), and a shoulder-three revolving decoupling mechanism (212), a shoulder-three revolving shaft (34) is arranged in the shoulder-three rotor (209), and the shoulder-three revolving decoupling mechanism (212) is connected to the shoulder-three revolving joint (4) via the shoulder-three revolving shaft (34).
2. The rope-driven passively decoupled three-degree-of-freedom series shoulder joint according to claim 1, characterized in that: The three-degree-of-freedom joint also includes a rear end joint driving rope (8), a shoulder three joint driving rope (9), a shoulder two joint coupling rope (10), a shoulder one joint driving rope (11), a shoulder one joint coupling rope (12) and a shoulder two joint driving rope (13); The shoulder-joint driving rope (11) is connected to the shoulder-rotor (201) via the shoulder-swivel joint (2), and the shoulder-joint driving rope (11) is used to drive the shoulder-winding wheel (213) to rotate; One end of the shoulder-joint coupling rope (12) is fixed to the shoulder-joint coupling wheel (55), and the other end is fixed to the fixed base (7); The shoulder joint coupling rope (10) is connected to the fixed base (7) via the shoulder joint (2) and the base decoupling mechanism (1) in sequence; One end of the shoulder joint driving rope (13) is connected to the base decoupling mechanism (1), and the other end is connected to the second motor winding wheel (6); One end of the shoulder three joint driving rope (9) is fixed to the shoulder three rotor (209), and the other end is connected to the third motor winding wheel through the shoulder two pitch joint (3), the shoulder one swivel joint (2), and the base decoupling mechanism (1) in sequence; One end of the rear end joint driving rope (8) is fixed to the rear end movable joint, and the other end is connected to the motor winding wheel (5) through the shoulder three rotation decoupling mechanism (212), the shoulder two pitch joint (3), the shoulder one rotation joint (2) and the base decoupling mechanism (1) in sequence.
3. The rope-driven passively decoupled three-degree-of-freedom series shoulder joint according to claim 2, characterized in that: The shoulder-one reel (213), the shoulder-two reel (207), the shoulder-three reel (210), and the rear-end movable joint are driven by the torque difference generated by the shoulder-one joint driving rope (11), the shoulder-two joint driving rope (13), the shoulder-three joint driving rope (9), and the rear-end joint driving rope (8).
4. The rope-driven passively decoupled three-degree-of-freedom series shoulder joint according to claim 1, characterized in that: The shoulder three rotor (209) is connected to the inner ring of the second cross roller bearing (211), and the outer ring of the second cross roller bearing (211) is connected to the shoulder three upper stator (208); The shoulder second coupling wheel is connected to the shoulder second fixed shaft (206) via a first deep groove ball bearing (214), and the shoulder second first winding wheel (207) and the shoulder second second winding wheel (207) are connected to the shoulder second fixed shaft (206) via second deep groove ball bearings (216) respectively; The shoulder rotor (201) is connected to the fixed base (7) via the inner ring of the first cross roller bearing (203), and the outer ring of the cross roller bearing (215) is fixed on the fixed base (7).
5. The rope-driven passively decoupled three-DOF series shoulder joint according to claim 1, characterized in that: The shoulder three-swivel joint (4) comprises a shoulder three-swivel shaft (34), an active coupling wheel (35), a follower decoupling wheel set (37), a driving gear (31), a follower gear (32), a fixed gear (33), a follower bracket (36), a fixed coupling wheel (38), a shoulder three-winding wheel (210), a shoulder three-guide pulley (40), and a rear end guide pulley (41); The driving gear (31), the follower gear (32) and the fixed gear (33) form a planetary gear train, forming a differential motion mechanism; The shoulder three winding wheel (210) transmits movement to the shoulder three rotation decoupling mechanism through the shoulder three rotation shaft (34), driving the driving gear (31) to move. The driving gear (31) and the shoulder three rotation shaft (34) have the same rotation speed. The follower gear (32) is respectively meshed with the driving gear (31) and the fixed gear (33). The fixed gear (33) is fixedly connected to the shoulder two pitch joint (3).
6. The rope-driven passively decoupled three-DOF series shoulder joint according to claim 2, characterized in that: The base decoupling mechanism (1) comprises a base coupling pulley (51), a first base reversing pulley (52), a first movable pulley group (53), a second movable pulley group (54), a shoulder coupling wheel (55), a shoulder rotating shaft (56), a shoulder guide pulley (57), a linear guide rail (58) and a slider (59); The shoulder-swivel joint (2) is connected to the shoulder-swivel shaft (56) via a shoulder-rotor (201); the shoulder-coupling wheel (55) is fixed to the output end of the shoulder-swivel shaft (56); and the shoulder-swivel joint (2), the shoulder-swivel shaft (56) and the shoulder-coupling wheel (55) rotate at the same angular velocity; One end of the shoulder-joint driving rope (11) is fixed on a shoulder-joint driving winding wheel (213), the shoulder-joint driving rope (11) is wound in a same-direction closed loop, the other end of the shoulder-joint driving rope (11) is fixed on a first motor winding wheel (5), and the shoulder-joint driving rope (11) is composed of an opening and closing line and a contraction line in opposite winding directions; The fixed end of the shoulder-joint coupling rope (12) is fixed to the shoulder-joint coupling wheel (55), and the movable end of the shoulder-joint coupling rope (12) is fixed to the fixed base (7) after passing through the first base reversing pulley (52) and the first movable pulley group (53) in sequence. The shoulder-joint coupling rope consists 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 (52) and the first movable pulley group (53) in opposite winding directions.
7. The rope-driven passively decoupled three-DOF series shoulder joint according to claim 6, characterized in that: One end of the shoulder joint coupling rope (10) is fixed on the shoulder joint rotor (205); the opening and closing line and the contraction line of the shoulder joint coupling rope (10) are reversely passed around the shoulder joint winding wheel (207) to drive the shoulder joint pitch joint (3) to rotate forward and reversely; the output end of the shoulder joint coupling rope (10) is fixed on the fixed base (7) after passing through the base coupling pulley (51), the base reversing pulley (52), the first movable pulley group (53) and the second movable pulley group (54) in sequence; One end of the shoulder joint driving rope (13) is fixed on the movable pulley group (53), and the shoulder joint driving rope (13) passes through the driving guide pulley (58) in sequence, and the shoulder joint driving rope (13) is wound around the second motor winding wheel (6) in the opposite direction.
8. The rope-driven passively decoupled three-DOF series shoulder joint according to claim 6, characterized in that: One end of the shoulder three joint driving rope (13) is fixed on the shoulder three rotor (209), and the shoulder three joint driving rope (13) passes through the shoulder three guide pulley (40), the shoulder two winding wheel (207), the base coupling wheel (51), the base reversing wheel (52), the first movable pulley group (53) and the second movable pulley group (54) in sequence, then bypasses the driving guide wheel (58) and is wound around the third motor winding wheel in the opposite direction.
9. The rope-driven passively decoupled three-DOF series shoulder joint according to claim 6, characterized in that: One end of the rear end joint drive rope (8) is fixed to the rear end joint. The rear end joint drive rope (8) passes through the rear end guide pulley (41), the active coupling wheel (35), the follower decoupling pulley group (37), the fixed coupling wheel (38), the shoulder second winding wheel (207), the base coupling wheel (51), the base reversing wheel (52), the first movable pulley group (53), and the second movable pulley group (54) in sequence, and then bypasses the driving guide wheel (58). The rear end joint drive rope (8) is wound around the fourth motor winding wheel (5) in the opposite direction.
10. The rope-driven passively decoupled three-DOF series shoulder joint according to claim 1, characterized in that: The first movable pulley group (53) and the second movable pulley group (54) are mounted on a slider (59), and the slider (59) is mounted on a linear guide rail (58). The slider (59) can reciprocate linearly along the linear guide rail (58), and the linear guide rail (58) is arranged on the fixed base (7).
Citation Information
Patent Citations
Mechanical arm driven by multi-motor coupling line
CN109551469A
Variable-stiffness flexible cable driven seven-degree-of-freedom series spraying mechanical arm
CN115107012A
Development of wearable robot mechanism for 3 dof shoulder joint behavior
KR1020090036177A
Cited By
Large-load rope-driven agile mechanical arm based on three-degree-of-freedom differential joint
CN119927890A
A large-load rope-driven agile robotic arm based on three-degree-of-freedom differential joints
CN119927890B
Central driving type three-degree-of-freedom humanoid robot shoulder joint mechanism
CN120862748A
