A rope-driven three-degree-of-freedom hybrid spherical wrist joint
By designing the three-degree-of-freedom mixed spherical wrist joint of rope drive, using rope drive and pulley set to transmit torque, the problem of large inertia in the wrist structure of traditional robotic arm is solved, high-speed movement and agile operation are achieved, and control accuracy is improved.
Patent Information
- Application Number
- CN202411342545.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-25
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-09-25
AI Technical Summary
The traditional mechanical arm wrist structure is installed at the end, resulting in large end mass and moment of inertia, making it difficult to achieve high-speed movement and dexterous operation.
Design a rope-drive three-degree-of-freedom mixed spherical wrist joint, adopting a combined structure of base, wrist bracket, pitch bracket, swing platform, double universal joint and driving source, transmit torque through rope drive and pulley set to reduce joints The moment of inertia is transmitted through the double-universal joint to avoid coupling with the front joint.
It realizes the agile robotic arm's dexterity operation and high-speed movement, reduces the inertia of the joints, improves control accuracy and operation flexibility.
Smart Images

Figure CN118876108B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of mechanical arms, and in particular to a rope-driven three-degree-of-freedom hybrid spherical wrist joint and a control method thereof. Background Art
[0002] The traditional serial robot wrist structure is large in size, and the motor and reducer are directly installed at the end of the robot, resulting in a large mass and inertia at the end of the robot. In order to adapt to more complex and delicate operation tasks and realize anthropomorphic wrist joints, the robot wrist is developing in the direction of parallel, compact structure, and simple principle. However, the parallel wrist structure mostly adopts a connecting rod type, which has a small range of motion and is peculiar. At the same time, the multi-link structure requires high processing accuracy and assembly accuracy of the connecting rod, which increases the production cost. The current robot wrist structure mainly realizes transmission through traditional mechanical transmission (gear transmission, belt transmission, etc.), pneumatics, etc., which still leads to large mass and inertia of the end joint, making it difficult to achieve high-speed movement and dexterous operation of the robot. Summary of the invention
[0003] The present invention provides a rope-driven three-degree-of-freedom hybrid spherical wrist joint and a control method thereof, aiming to solve at least one of the technical problems existing in the prior art.
[0004] The technical solution of the present invention is a rope-driven three-degree-of-freedom hybrid spherical wrist joint, comprising:
[0005] A base, wherein a driving wheel is arranged on the base;
[0006] A wrist support, the wrist support is arranged above the base and connected to the base;
[0007] A pitch support, the pitch support being connected to the top of the wrist support;
[0008] A slewing platform, the slewing platform is arranged above the pitch bracket, and the slewing platform is connected to the top of the pitch bracket through a bearing;
[0009] A double universal joint, wherein the double universal joint is arranged inside the space formed by the wrist bracket and the pitch bracket, and the top of the double universal joint passes through the pitch bracket and is connected to the rotary platform;
[0010] A driving source is connected to the bottom of the double universal joint.
[0011] Further, the wrist support includes a base, a first side plate, a second side plate, a first differential wheel, a second differential wheel, a third differential wheel and a fourth differential wheel,
[0012] The base is arranged above the pedestal, the base and the pedestal are connected through a deep groove ball bearing, the wrist bracket and the inner ring of the deep groove ball bearing are connected as a rotor, and the pedestal and the outer ring of the deep groove ball bearing are connected as a stator;
[0013] The first side panel and the second side panel are respectively perpendicular to and opposite to the base, and the first side panel and the second side panel are respectively provided with a weight-reducing hollow area.
[0014] Further, the first differential wheel is arranged above the base, the first differential wheel and the base are connected via a bearing, the second differential wheel is arranged above the first differential wheel, the second differential wheel and the first differential wheel are connected via a bearing, and the base, the first differential wheel and the second differential wheel can independently complete the rotational motion;
[0015] The third differential wheel is fixed to the first side of the pitch bracket by screws, the fourth differential wheel is fixed to the second side of the pitch bracket by screws, the third differential wheel is connected to the first side plate by screws and bearings, the fourth differential wheel is connected to the second side plate by screws and bearings, and the pitch bracket can perform pitch motion around the central axis formed by the third differential wheel and the fourth differential wheel.
[0016] Furthermore, the wrist support further includes a first coupling line, a second coupling line, a first guide pulley and a second guide pulley.
[0017] The first guide pulley is used to guide the first coupling line from the first differential wheel to the third differential wheel, and the second guide pulley is used to guide the second coupling line from the second differential wheel to the fourth differential wheel.
[0018] Further, one end of the first coupling line is fixed on the first differential wheel, and the other end of the first coupling line is fixed on the third differential wheel. The first coupling line includes a first opening and closing line and a first contraction line. The first opening and closing line and the first contraction line are respectively wound on the first differential wheel through the first guide pulley. The winding direction of the first opening and closing line and the first contraction line on the third differential wheel is opposite to the winding direction on the first differential wheel. The wrap angle of the first coupling line on the first differential wheel and the third differential wheel is 180°.
[0019] One end of the second coupling line is fixed on the second differential wheel, and the other end of the second coupling line is fixed on the fourth differential wheel. The second coupling line includes a second opening and closing line and a second contraction line. The second opening and closing line and the second contraction line are respectively wound on the second differential wheel through a second guide pulley. The winding direction of the second opening and closing line and the second contraction line on the fourth differential wheel is opposite to the winding direction on the second differential wheel. The wrap angle of the second coupling line on the second differential wheel and the fourth differential wheel is 180°.
[0020] Further, the double universal joint comprises a first universal joint, a spline and a second universal joint connected in sequence;
[0021] The first universal joint comprises a first U-shaped bracket, a first connecting block and a first cylindrical pin which are connected in sequence, the top of the first U-shaped bracket is connected to the bottom of the pitch bracket, the first connecting block is provided with a first flange bearing and a second flange bearing, the first U-shaped bracket passes through the inner ring of the first flange bearing, and the first cylindrical pin passes through the inner ring of the second flange bearing;
[0022] The second universal joint includes a second U-shaped bracket, a second connecting block and a second cylindrical pin connected in sequence, the top of the second U-shaped bracket is connected to the bottom of the spline, the second connecting block is provided with a third flange bearing and a fourth flange bearing, the second U-shaped bracket passes through the inner ring of the third flange bearing, and the second cylindrical pin passes through the inner ring of the fourth flange bearing.
[0023] Furthermore, the length of the second cylindrical pin is greater than the length of the first cylindrical pin.
[0024] Furthermore, a mounting hole for mounting an end operating device of the robot arm is provided above the rotary platform.
[0025] Furthermore, the driving wheel comprises a first driving wheel and a second driving wheel,
[0026] The first driving wheel and the first differential wheel are fixed by screws, and the second driving wheel and the second differential wheel 52 are fixed by screws.
[0027] The first differential wheel and the second differential wheel are respectively provided with threaded holes in the circumferential radial direction.
[0028] Furthermore, the base also includes a base pulley for guiding the driving line to the driving source.
[0029] The beneficial effects of the present invention are:
[0030] The rope-driven three-degree-of-freedom hybrid spherical wrist joint can obtain the working parameters of each servo motor according to the rotation angle of the rotating platform, and the servo motor works according to the working parameters. Since the opening and closing line and the contraction line have opposite winding directions on the driver, the opening and closing line and the contraction line undergo opposite displacements, which are transmitted to the driving wheel through the pulley set, so that the first differential wheel, the second differential wheel, the third differential wheel and the fourth differential wheel rotate accordingly. When the driving wheels are driven in the same direction, the wrist bracket rotates around the central axis, and when the driving wheels rotate in the opposite direction, the pitch bracket rotates around the axis. By adopting rope drive, the driving wheel can be kept away from the end to reduce the inertia of the joint, and the double universal joint is used to transmit the end rotation motion to avoid coupling with the front end joint. At the same time, the driving source is placed at the rear, which can realize the dexterous operation and high-speed movement of the agile robotic arm. BRIEF DESCRIPTION OF THE DRAWINGS
[0031] Figure 1 This is the overall structure diagram of the rope-driven three-degree-of-freedom hybrid spherical wrist joint.
[0032] Figure 2 This is the exploded structure diagram of the rope-driven three-degree-of-freedom hybrid spherical wrist joint.
[0033] Figure 3 Schematic diagram of the first coupling line and the second coupling line in the rope-driven three-degree-of-freedom hybrid spherical wrist joint.
[0034] Figure 4 This is a cross-sectional schematic diagram of a rope-driven three-degree-of-freedom hybrid spherical wrist joint.
[0035] Figure 5 Schematic diagram of the double universal joint in the rope-driven three-degree-of-freedom hybrid spherical wrist joint.
[0036] Figure 6 Schematic diagram of the layout of the driving source in the rope-driven three-degree-of-freedom hybrid spherical wrist joint.
[0037] 1. base; 2. base; 3. first side plate; 4. second side plate; 51. first differential wheel; 52. second differential wheel; 53. third differential wheel; 54. fourth differential wheel; 55. first coupling line; 56. second coupling line; 6. pitch bracket; 7. rotary platform; 8. double universal joint; 81. first universal joint; 811. first U-shaped bracket; 812. first connecting block; 813. first cylindrical pin; 82. spline; 83. second universal joint; 831. second U-shaped bracket; 832. second connecting block; 833. second cylindrical pin; 9. driving source; 91. first driving source; 92. second driving source; 93. third driving source; 10. first guide pulley; 11. driving wheel; 12. base pulley; 13. second guide pulley. DETAILED DESCRIPTION
[0038] 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.
[0039] 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.
[0040] 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.
[0041] 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.
[0042] Reference Figures 1 to 6 In some embodiments, the technical solution of the present invention is a rope-driven three-degree-of-freedom hybrid spherical wrist joint and a control method thereof, referring to Figure 1 and Figure 2 The rope-driven three-degree-of-freedom hybrid spherical wrist joint comprises:
[0043] A base 1, wherein a driving wheel 11 is provided on the base 1;
[0044] A wrist support, the wrist support is arranged above the base 1 and connected to the base 1;
[0045] A pitch support 6, wherein the pitch support 6 is connected to the top of the wrist support;
[0046] A slewing platform 7, wherein the slewing platform 7 is arranged above the pitch bracket 6, and the slewing platform 7 is connected to the top of the pitch bracket 6 through a bearing;
[0047] A double universal joint 8, wherein the double universal joint 8 is arranged inside the space formed by the wrist bracket and the pitch bracket 6, and the top of the double universal joint 8 passes through the pitch bracket 6 and is connected to the rotary platform 7;
[0048] A driving source 9 is connected to the bottom of the double universal joint 8 .
[0049] The beneficial effects of the present invention are:
[0050] The rope-driven three-degree-of-freedom hybrid spherical wrist joint can obtain the working parameters of each servo motor according to the rotation angle of the rotating platform 7. The servo motor works according to the working parameters. Since the opening and closing lines and the contraction lines are wound in opposite directions on the driver, the opening and closing lines and the contraction lines undergo opposite displacements, which are transmitted to the driving wheel 11 through the pulley set, so that the first differential wheel 51, the second differential wheel 52, the third differential wheel 53 and the fourth differential wheel 54 rotate accordingly. When the driving wheel 11 is driven in the same direction, the wrist bracket rotates around the central axis. When the driving wheel 11 rotates in the opposite direction, the pitch bracket 6 rotates around the axis. By adopting rope drive, the driving wheel 11 can be kept away from the end to reduce the inertia of the joint, and the double universal joint 8 is used to transmit the end rotation motion to avoid coupling with the front end joint. At the same time, the driving source 9 is placed at the rear, which can realize the dexterous operation and high-speed movement of the agile robotic arm.
[0051] Further, refer to Figure 1 and Figure 2 The wrist support includes a base 2, a first side plate 3, a second side plate 4, a first differential wheel 51, a second differential wheel 52, a third differential wheel 53 and a fourth differential wheel 54,
[0052] The base 2 is arranged above the base 1, the base 2 and the base 1 are connected through a deep groove ball bearing, the wrist bracket and the inner ring of the deep groove ball bearing are connected as a rotor, and the base 1 and the outer ring of the deep groove ball bearing are connected as a stator;
[0053] The first side panel 3 and the second side panel 4 are respectively arranged perpendicular to and opposite to the base 2 , and the first side panel 3 and the second side panel 4 are respectively provided with a weight-reducing hollow area.
[0054] Specifically, the first side plate 3, the second side plate 4 and the base 2 are vertically fixed by screws to form a wrist bracket, and the first side plate 3 and the second side plate 4 are provided with a weight-reducing hollow area to reduce the mass of the wrist bracket. The wrist bracket and the base 1 are connected by a deep groove ball bearing, wherein the wrist bracket and the inner ring of the bearing are connected as a rotor, and the base 1 and the outer ring of the bearing are connected as a stator, so that the wrist bracket can rotate relative to the base 1.
[0055] Further, refer to Figures 1 to 3, the first differential wheel 51 is arranged above the base 2, the first differential wheel 51 and the base 2 are connected through a bearing, the second differential wheel 52 is arranged above the first differential wheel 51, the second differential wheel 52 and the first differential wheel 51 are connected through a bearing, and the base 2, the first differential wheel 51 and the second differential wheel 52 can independently complete the rotation motion;
[0056] The third differential wheel 53 is fixed to the first side of the pitch bracket 6 by screws, the fourth differential wheel 54 is fixed to the second side of the pitch bracket 6 by screws, the third differential wheel 53 is connected to the first side plate 3 by screws and bearings, the fourth differential wheel 54 is connected to the second side plate 4 by screws and bearings, and the pitch bracket 6 can perform pitch motion around the central axis formed by the third differential wheel 53 and the fourth differential wheel 54.
[0057] Specifically, the first differential wheel 51 and the second differential wheel 52 are connected to the wrist support plane, the third differential wheel 53 and the fourth differential wheel 54 are fixed to the pitch support 6, the pitch support 6 is connected to the wrist support, the third differential wheel 53 is connected to the second differential wheel 52 through a first coupling line 55, and the fourth differential wheel 54 is connected to the first differential wheel 51 through a second coupling line 56.
[0058] Further, refer to Figures 1 to 3 The wrist support further comprises a first coupling line 55, a second coupling line 56, a first guide pulley 10 and a second guide pulley 13,
[0059] The first guide pulley 10 is used to guide the first coupling line 55 from the first differential wheel 51 to the third differential wheel 53 , and the second guide pulley 13 is used to guide the second coupling line 56 from the second differential wheel 52 to the fourth differential wheel 54 .
[0060] Further, refer to Figures 1 to 3 , one end of the first coupling line 55 is fixed on the first differential wheel 51, and the other end of the first coupling line 55 is fixed on the third differential wheel 53. The first coupling line 55 includes a first opening and closing line and a first contraction line. The first opening and closing line and the first contraction line are respectively wound on the first differential wheel 51 through the first guide pulley 10. The winding direction of the first opening and closing line and the first contraction line on the third differential wheel 53 is opposite to the winding direction on the first differential wheel 51. The wrap angle of the first coupling line 55 on the first differential wheel 51 and the third differential wheel 53 is 180°;
[0061] One end of the second coupling line 56 is fixed on the second differential wheel 52, and the other end of the second coupling line 56 is fixed on the fourth differential wheel 54. The second coupling line 56 includes a second opening and closing line and a second contraction line. The second opening and closing line and the second contraction line are respectively wound on the second differential wheel 52 through the second guide pulley 13. The winding direction of the second opening and closing line and the second contraction line on the fourth differential wheel 54 is opposite to the winding direction on the second differential wheel 52. The wrap angle of the second coupling line 56 on the second differential wheel 52 and the fourth differential wheel 54 is 180°.
[0062] Further, refer to Figure 5 , the double universal joint 8 comprises a first universal joint 81, a spline 82 and a second universal joint 83 which are connected in sequence;
[0063] The first universal joint 81 includes a first U-shaped bracket 811, a first connecting block 812 and a first cylindrical pin 813 which are connected in sequence. The top of the first U-shaped bracket 811 is connected to the bottom of the pitch bracket 6. The first connecting block 812 is provided with a first flange bearing and a second flange bearing. The first U-shaped bracket 811 passes through the inner ring of the first flange bearing, and the first cylindrical pin 813 passes through the inner ring of the second flange bearing.
[0064] The second universal joint 83 includes a second U-shaped bracket 831, a second connecting block 832 and a second cylindrical pin 833 which are connected in sequence, the top of the second U-shaped bracket 831 is connected to the bottom of the spline 82, the second connecting block 832 is provided with a third flange bearing and a fourth flange bearing, the second U-shaped bracket 831 passes through the inner ring of the third flange bearing, and the second cylindrical pin 833 passes through the inner ring of the fourth flange bearing.
[0065] Specifically, the double universal joint 8 includes a first universal joint 81 and a second universal joint 83. The universal joint includes a U-shaped bracket, a connecting block, a cylindrical pin shaft, and a flange bearing is provided in the connecting block. The cylindrical pin shaft passes through the inner ring of the flange bearing so that the connecting block can rotate around the axis of the U-shaped bracket. The universal joint adopts a cross-axis staggered connection, and each universal joint has two degrees of freedom to achieve rotational motion in two directions. Among them, the first axis of the first universal joint 81 and the second axis are perpendicular, the first axis of the second universal joint 83 and the second axis are perpendicular, and the second axis of the first universal joint 81 and the first axis of the second universal joint 83 are parallel. The first universal joint 81 and the second universal joint 83 are connected by a spline 82 to form a double universal joint 8 structure. When the double universal joint 8 structure transmits motion, it can transmit the motion at a constant speed to improve the control accuracy. One end of the double universal joint 8 is connected to the driving source 9, and the other end is connected to the rotary platform 7 for transmitting the terminal rotary motion. The distance from the second axis of the first universal joint 81 of the double universal joint 8 to the axis of the pitch bracket 6 is equal to the distance from the first axis of the second universal joint 83 to the axis of the pitch bracket 6 .
[0066] In another embodiment, the double universal joint 8 adopts a constant velocity universal joint structure of a ball cage universal joint structure. Specifically, the ball cage universal joint structure is mainly composed of an inner ball head, an outer ball head, a universal rod, a shaft sleeve, a stop ring, etc. The inner ball head and the outer ball head are both spherical, the inner ball head is connected to the universal rod, the outer ball head is connected to the shaft sleeve, the shaft sleeve is connected to the mechanical equipment, the stop ring plays a role of fixing and limiting, and the structure between the inner ball head and the outer ball head is a spherical sleeve, which can realize universal rotation.
[0067] Further, refer to Figure 5 , the length of the second cylindrical pin 833 is greater than the length of the first cylindrical pin 813.
[0068] Further, refer to Figure 1 , Figure 2 and Figure 4 A mounting hole for mounting the end operating device of the robot arm is arranged above the rotary platform 7.
[0069] Specifically, the slewing platform 7 and the pitch bracket 6 are connected by bearings, and the slewing platform 7 can rotate relative to the pitch bracket 6. The double universal joint 8 can transmit the end rotary motion at a constant speed to improve the control accuracy. At the same time, since the double universal joint 8 adopts a spline connection, when the joint performs pitch motion, the spline sleeve will move relative to the spline shaft to avoid the coupling of the pitch motion and the end rotary motion. The slewing platform 7 is provided with mounting holes, which can be used to install the end operating devices of the robot arm such as the gripper.
[0070] Further, refer to Figure 1 and Figure 2 The driving wheel 11 includes a first driving wheel and a second driving wheel.
[0071] The first driving wheel 11 and the first differential wheel 51 are fixed by screws, and the second driving wheel and the second differential wheel 52 are fixed by screws.
[0072] The first differential gear 51 and the second differential gear 52 are respectively provided with threaded holes in the circumferential radial direction.
[0073] In a specific embodiment, the driving wheel 11 is mounted on the base 1 , and the driving wheel 11 is driven to rotate by the torque difference generated by the driving wire wound around the driving wheel 11 , thereby driving the wrist support to rotate and driving the pitch support 6 to move.
[0074] Further, refer to Figure 1 and Figure 2 The base 1 also includes a base pulley 12 for guiding the driving line to the driving source 9.
[0075] Specifically, a base pulley 12 group is fixed on the base 1 and is used to guide the driving wire to the driving source 9 at the rear end of the robot arm.
[0076] Reference Figure 6 In a specific embodiment, the driving source 9 includes a first driving source 91, a second driving source 92 and a third driving source 93. The first driving source 91 and the second driving source 92 are respectively placed on the arm through the elbow joint, and the third driving source 93 is fixed on the wrist bracket. The output end of the third driving source 93 is connected to the double universal joint 8.
[0077] In a specific embodiment, the driving wire includes a driving opening and closing wire and a driving contraction wire, and the driving opening and closing wire and the driving contraction wire are wound on the driving wheel 11. The driving opening and closing wire and the driving contraction wire are wound on the driving source 9, and the winding directions of the driving opening and closing wire and the driving contraction wire on the driving source 9 are opposite.
[0078] In a specific embodiment, the first guide pulley 10 and the second guide pulley 13 are used to guide the driving wire from the driving wheel 11 to the driving source 9 .
[0079] Driving principle of the first rotation and pitch of the wrist:
[0080] One end of the first coupling line 55 is fixed on the first differential wheel 51, and the other end of the first coupling line 55 is fixed on the third differential wheel 53. The first coupling line 55 includes a first opening and closing line and a first contraction line. The first opening and closing line and the first contraction line are wound on the differential wheel through a guide pulley. The first opening and closing line and the first contraction line of the first coupling line 55 have opposite winding directions on the differential wheel.
[0081] The wrap angle of the first coupling line 55 between the first differential wheel 51 and the third differential wheel 53 is 180°, so as to ensure that the wrist joint can perform a pitch motion of more than ±90°.
[0082] One end of the second coupling line 56 is fixed on the second differential wheel 52, and the other end of the second coupling line 56 is fixed on the fourth differential wheel 54. The second coupling line 56 includes a second opening and closing line and a second contraction line. The second opening and closing line and the second contraction line are wound on the differential wheel through a guide pulley. The winding directions of the second opening and closing line and the second contraction line of the second coupling line 56 on the differential wheel are opposite.
[0083] The wrap angle of the second coupling line 56 at the second differential wheel 52 and the fourth differential wheel 54 is 180°, ensuring that the wrist joint can perform a pitch motion of more than ±90°.
[0084] The driving wheel 11 is spirally wound. Since the wrist joint needs to achieve a first rotational motion of ±180° and a second pitch motion of ±90°, the motion range of the driving wheel 11 is ±270°. Therefore, the driving wire is wound around the driving wheel 11 for at least 1.5 turns.
[0085] When the first driving wheel 11 and the second driving wheel 11 move in the same direction and at a constant speed, the first differential wheel 51 and the second differential wheel 52 also rotate in the same direction, and the third differential wheel 53 and the fourth differential wheel 54 have a tendency to move in the opposite direction. Since the third differential wheel 53 and the fourth differential wheel 54 are fixed on the pitch bracket 6, the pitch bracket 6 does not move, and the driving wrist bracket rotates around the axis. At this time, the wrap angle of the coupling line on the differential wheel does not change, and the driving line on the driving wheel 11 produces a corresponding change in rope length according to the output.
[0086] When the first driving wheel and the second driving wheel move in opposite directions at a constant speed, the first differential wheel 51 and the second differential wheel 52 also rotate in opposite directions, and the third differential wheel 53 and the fourth differential wheel 54 tend to move in the same direction. Since the third differential wheel 53 and the fourth differential wheel 54 are fixed on the pitch bracket 6, the pitch bracket 6 is driven to move, and the wrist bracket does not generate rotational motion. At this time, the wrap angle of the coupling line on the differential wheel changes according to the joint output angle, and the driving line on the driving wheel 11 produces a corresponding change in rope length according to the joint output angle.
[0087] When the two joints are driven simultaneously, the output angle of the slewing joint is equal to half of the sum of the output angles of the first drive wheel and the second drive wheel, and the output angle of the pitch joint is equal to half of the difference between the output angles of the first drive wheel and the second drive wheel.
[0088] The end rotary joint transmits constant speed through the double universal joint 8 to avoid coupling with the front end joint and ensure control accuracy.
[0089] The differential can drive the rotating platform 7 to roll and pitch, and the rolling motion of the terminal rotating platform 7 is realized by the double universal joint 8 structure. Among them, the motion range of the pitch freedom is ±90 degrees, and the motion range of the roll freedom is ±180 degrees.
[0090] In a specific embodiment, a driving line unit is also included, and the line driving unit includes an opening and closing line unit and a contraction line unit. The driving line drawn from the opening and closing line unit is an opening and closing line, and the driving line drawn from the contraction line unit is a contraction line. There are two driving lines corresponding to each driving wheel 11, including one opening and closing line and one contraction line. One opening and closing line and one contraction line are wound on a winding shaft. Each group of opening and closing lines and contraction lines are located on both sides of the driving wheel 11.
[0091] The driving line can be made of polyester fiber, which has the characteristics of high strength, high wear resistance, high chemical resistance, etc. The driving line can also be made of metal wire materials, such as steel wire rope, which has high strength, high toughness and high tensile strength.
[0092] In a specific embodiment, a line driving unit is further included, and the line driving unit includes a driving source 9, which is a servo motor. The opening and closing wire and the contraction wire are wound around the driving source 9, and the winding directions of the opening and closing wire and the contraction wire on the driving source 9 are opposite.
[0093] According to requirements, it also includes a first servo motor and a second servo motor. The first servo motor and the second servo motor are arranged at the rear end of the wrist joint, such as installed on the arm rod of the robot joint, to reduce the mass and inertia of the end joint of the robot arm.
[0094] The first roll joint and the second pitch joint of the wrist joint are differentially driven. When one of the joints does not need to move, two motors can be used to drive the same joint to achieve torque superposition and improve load capacity.
[0095] Compared with the traditional gear differential mechanism, the rope drive can arrange some differential wheels at any position and direction, with high flexibility to adapt to the requirements of different spaces and shapes; the rope drive can adjust the different stiffness of the joint by tensioning the rope to adapt to different working environment requirements; at the same time, the rope drive has the advantage of no backlash, which improves the control accuracy of the joint.
[0096] Rope drive has a simple structure, is easy to manufacture and maintain, and has high reliability; it has strong load-bearing capacity, and the drive line can be selected with different diameters and materials as needed to meet different load-bearing requirements; it has high transmission efficiency, and rope drive can improve transmission efficiency by reasonably selecting drive line materials to reduce friction. Rope drive is suitable for low-speed, high-torque transmission occasions, with less noise and vibration.
[0097] The driving source uses a joint module to drive the wrist joint. The joint module used has a built-in reducer and motor driver, which has the characteristics of small size and light weight. At the same time, it can provide higher torque and speed to meet the needs of high-speed joint movement.
[0098] Some joints use rope transmission. Since the flexibility of the rope will affect the control accuracy, you can consider adding absolute joint encoders at each joint end to obtain feedback values of the joint movement and improve control accuracy.
[0099] The control steps of each wrist joint are as follows:
[0100] When a single joint is driven, the first drive source 91 and the second drive source 92 The angular velocity of the same direction When the first roll joint is driven Angular velocity motion The first driving source 91 and the second driving source 92 are The angular velocity of the reverse motion When the second pitch joint is driven Angular velocity motion The third driving source 93 is Angular velocity motion When the third roll joint is driven Angular velocity motion .
[0101] When the first roll joint and the second pitch joint are driven in parallel, the first driving source 91 is sports The second driving source 92 is sports When the first roll joint sports , The second pitch joint sports .
[0102] 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 three-degree-of-freedom hybrid spherical wrist joint, It is characterized in that include: A base (1), wherein a driving wheel (11) is provided on the base (1); A wrist support, the wrist support being arranged above the base (1) and connected to the base (1); A pitch support (6), the pitch support (6) being connected to the top of the wrist support; A slewing platform (7), the slewing platform (7) being arranged above the pitch bracket (6), the slewing platform (7) being connected to the top of the pitch bracket (6) via a bearing; A double universal joint (8), the double universal joint (8) being arranged inside a space formed by the wrist support and the pitch support (6), the top of the double universal joint (8) passing through the pitch support (6) and connected to the rotary platform (7); A driving source (9), the driving source (9) being connected to the bottom of the double universal joint (8); The wrist support comprises a base (2), a first side plate (3), a second side plate (4), a first differential wheel (51), a second differential wheel (52), a third differential wheel (53) and a fourth differential wheel (54). The base (2) is arranged above the pedestal (1), the base (2) and the pedestal (1) are connected via a deep groove ball bearing, the wrist bracket and the inner ring of the deep groove ball bearing are connected to serve as a rotor, and the pedestal (1) and the outer ring of the deep groove ball bearing are connected to serve as a stator; The first side panel (3) and the second side panel (4) are respectively arranged perpendicularly to and opposite to the base (2), and the first side panel (3) and the second side panel (4) are respectively provided with a weight-reducing hollow area; The first differential wheel (51) is arranged above the base (2), the first differential wheel (51) and the base (2) are connected via a bearing, the second differential wheel (52) is arranged above the first differential wheel (51), the second differential wheel (52) and the first differential wheel (51) are connected via a bearing, and the base (2), the first differential wheel (51) and the second differential wheel (52) can independently complete a rotational motion; The third differential wheel (53) is fixed to the first side of the pitch bracket (6) by screws, the fourth differential wheel (54) is fixed to the second side of the pitch bracket (6) by screws, the third differential wheel (53) is connected to the first side plate (3) by screws and bearings, the fourth differential wheel (54) is connected to the second side plate (4) by screws and bearings, and the pitch bracket (6) can perform pitch motion around a central axis formed by the third differential wheel (53) and the fourth differential wheel (54); The wrist support further comprises a first coupling line (55), a second coupling line (56), a first guide pulley (10) and a second guide pulley (13). The first guide pulley (10) is used to guide the first coupling line (55) from the first differential wheel (51) to the third differential wheel (53), and the second guide pulley (13) is used to guide the second coupling line (56) from the second differential wheel (52) to the fourth differential wheel (54); One end of the first coupling line (55) is fixed on the first differential wheel (51), and the other end of the first coupling line (55) is fixed on the third differential wheel (53); the first coupling line (55) comprises a first opening and closing line and a first contraction line; the first opening and closing line and the first contraction line are respectively wound on the first differential wheel (51) through the first guide pulley (10); the winding direction of the first opening and closing line and the first contraction line on the third differential wheel (53) is opposite to the winding direction on the first differential wheel (51); the wrap angle of the first coupling line (55) on the first differential wheel (51) and the third differential wheel (53) is 180°; One end of the second coupling line (56) is fixed on the second differential wheel (52), and the other end of the second coupling line (56) is fixed on the fourth differential wheel (54). The second coupling line (56) comprises a second opening and closing line and a second contraction line. The second opening and closing line and the second contraction line are respectively wound on the second differential wheel (52) through a second guide pulley (13). The winding direction of the second opening and closing line and the second contraction line on the fourth differential wheel (54) is opposite to the winding direction on the second differential wheel (52). The wrap angle of the second coupling line (56) on the second differential wheel (52) and the fourth differential wheel (54) is 180°.
2. The rope-driven three-degree-of-freedom hybrid spherical wrist joint according to claim 1, It is characterized in that The double universal joint (8) comprises a first universal joint (81), a spline (82) and a second universal joint (83) which are connected in sequence; The first universal joint (81) comprises a first U-shaped bracket (811), a first connecting block (812) and a first cylindrical pin (813) which are connected in sequence, the top of the first U-shaped bracket (811) is connected to the bottom of the pitch bracket (6), the first connecting block (812) is provided with a first flange bearing and a second flange bearing, the first U-shaped bracket (811) passes through the inner ring of the first flange bearing, and the first cylindrical pin (813) passes through the inner ring of the second flange bearing; The second universal joint (83) comprises a second U-shaped bracket (831), a second connecting block (832) and a second cylindrical pin shaft (833) which are connected in sequence, the top of the second U-shaped bracket (831) is connected to the bottom of the spline (82), the second connecting block (832) is provided with a third flange bearing and a fourth flange bearing, the second U-shaped bracket (831) passes through the inner ring of the third flange bearing, and the second cylindrical pin shaft (833) passes through the inner ring of the fourth flange bearing.
3. The rope-driven three-degree-of-freedom hybrid spherical wrist joint according to claim 2, It is characterized in that The length of the second cylindrical pin (833) is greater than the length of the first cylindrical pin (813).
4. The rope-driven three-degree-of-freedom hybrid spherical wrist joint according to claim 1, It is characterized in that A mounting hole for mounting an operating device at the end of the robotic arm is provided above the rotary platform (7).
5. The rope-driven three-degree-of-freedom hybrid spherical wrist joint according to claim 1, It is characterized in that The driving wheel (11) comprises a first driving wheel and a second driving wheel, The first drive wheel and the first differential wheel (51) are fixed by screws, and the second drive wheel and the second differential wheel (52) are fixed by screws. The first differential wheel (51) and the second differential wheel (52) are respectively provided with threaded holes in the circumferential radial direction.
6. The rope-driven three-degree-of-freedom hybrid spherical wrist joint according to claim 1, It is characterized in that The base (1) also includes a base pulley (12) for guiding the drive line to the drive source (9).
Citation Information
Patent Citations
Integrated high-accuracy servo revolving platform
CN105382558A
Three degrees of freedom are arm under water
CN206623089U
Rope-driven series-parallel mechanical arm
CN221271143U
multi-row slewing bearing
DE202017000692U1
