CN112894780A - Rope-driven wrist module based on three-degree-of-freedom series-parallel mechanism and using method thereof - Google Patents
Rope-driven wrist module based on three-degree-of-freedom series-parallel mechanism and using method thereof Download PDFInfo
- Publication number
- CN112894780A CN112894780A CN202110360411.1A CN202110360411A CN112894780A CN 112894780 A CN112894780 A CN 112894780A CN 202110360411 A CN202110360411 A CN 202110360411A CN 112894780 A CN112894780 A CN 112894780A
- Authority
- CN
- China
- Prior art keywords
- rope
- parallel mechanism
- degree
- parallel
- freedom
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 230000007246 mechanism Effects 0.000 title claims abstract description 160
- 210000000707 wrist Anatomy 0.000 title claims abstract description 42
- 238000000034 method Methods 0.000 title description 9
- 230000033001 locomotion Effects 0.000 claims abstract description 31
- 238000005096 rolling process Methods 0.000 claims abstract description 31
- 238000004804 winding Methods 0.000 claims description 53
- 230000003321 amplification Effects 0.000 claims description 18
- 230000005540 biological transmission Effects 0.000 claims description 18
- 230000008878 coupling Effects 0.000 claims description 18
- 238000010168 coupling process Methods 0.000 claims description 18
- 238000005859 coupling reaction Methods 0.000 claims description 18
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 18
- 238000005452 bending Methods 0.000 claims description 8
- 230000008859 change Effects 0.000 claims description 4
- 230000008901 benefit Effects 0.000 abstract description 7
- 238000010586 diagram Methods 0.000 description 6
- 230000007547 defect Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000009467 reduction Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 239000011664 nicotinic acid Substances 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 235000001968 nicotinic acid Nutrition 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 210000002435 tendon Anatomy 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/003—Programme-controlled manipulators having parallel kinematics
- B25J9/0072—Programme-controlled manipulators having parallel kinematics of the hybrid type, i.e. having different kinematics chains
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/08—Programme-controlled manipulators characterised by modular constructions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/104—Programme-controlled manipulators characterised by positioning means for manipulator elements with cables, chains or ribbons
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
The invention discloses a rope-driven wrist module based on a three-degree-of-freedom series-parallel mechanism, which consists of a three-degree-of-freedom series-parallel module and a drive control integrated module, wherein the three-degree-of-freedom series-parallel module comprises a spherical pure rolling parallel mechanism and a tension amplifying mechanism, the spherical pure rolling parallel mechanism realizes two-degree-of-freedom spherical motion of a wrist, a lower platform of the parallel mechanism is designed to have one rotational degree of freedom, so that the series-parallel mechanism is formed, and the tension amplifying mechanism ensures that the mechanism is light in weight and does not lose rigidity; the driving and controlling integrated module is used for integrating the motor, the driver and the controller to form an independent electromechanical system; the serial-parallel mechanism is designed by combining the advantages of rope driving and modularization, has the advantages of light weight, reconfigurability, good flexibility and the like, has the configuration of the degree of freedom of the serial-parallel serial mechanism consistent with that of a real human wrist, can realize highly-vivid human-simulated wrist movement, and provides a new design idea for the design of the human-simulated service robot wrist.
Description
Technical Field
The invention relates to the technical field of humanoid service robot joints, in particular to a rope-driven wrist module based on a three-degree-of-freedom series-parallel mechanism and a using method thereof.
Background
The humanoid arm is an important execution system of the humanoid service robot, and with increasingly complex application scenes of humanoid services, the design of the humanoid arm joint needs to meet higher requirements of flexibility, light weight, reconfigurability and the like. The prior art that the multi-degree-of-freedom simulated arm joint is realized by adopting a traditional rigid mechanism has the defects of large mass, poor flexibility, complex structure and the like, and the requirement of the simulated arm to work in an unstructured environment is difficult to meet.
The rope driving mechanism is a mechanism for transmitting motion and power through a rope, belongs to a rigid-flexible coupling structure, and has the advantages of light weight, small inertia, good flexibility and the like, and the rope is flexible in transmission layout and is easy to realize multi-freedom configuration. In addition, from the perspective of bionics, a rope driving mode is similar to a human arm tendon driving mode, and is a reasonable scheme for realizing human arm bionic design, so that a rope driving mechanism is widely applied to design of a human arm-like joint, but in order to further reduce the quality of the human arm-like joint, most of rope-driven human-like arms are designed in a driving rear mode, the mode easily causes motion coupling between joints, and the problems of low control bandwidth, serious nonlinear friction and the like are caused by an overlong rope transmission line.
The human-simulated arm is realized by adopting a modularized idea, and can be respectively designed into a wrist module, an elbow module and a shoulder module, so that the problems of inter-joint motion coupling, overlong rope transmission line and the like caused by the fact that a rope drives the human-simulated arm to drive the rear part are solved; on the other hand, the humanoid arm has the advantage of reconfigurable arm length under different application scenes, namely, all joint modules of the humanoid arm are connected by adopting a standard mechanical interface, and the arm length can be changed by only adding connecting sections with different lengths among the modular joints.
At present, there are examples of designs of humanoid arms that respectively adopt a rope driving mechanism and a modular concept, for example, patent ZL201810632708.7 discloses a three-degree-of-freedom rope driving parallel mechanism with a tension amplifying mechanism, in which a movable platform and a stationary platform of the mechanism are connected by a hinge, and a side edge of the mechanism is driven by the tension amplifying mechanism consisting of a movable fixed pulley and a fixed pulley, and the mechanism can be applied to the wrists or shoulders of humanoid arms; patent 201910382872.1 discloses a five-degree-of-freedom modularized dulcimer playing mechanical arm, which adopts modularized thought design, the whole arm is mainly divided into a shoulder module, a big arm rotation module, an elbow module and a small arm module, and a motor and a driver are integrated in each joint module. Although both the rope driving mechanism and the modularization idea are applied to the design of the humanoid arm, the advantages of the rope driving mechanism and the modularization idea are fully fused, the defects of the rope driving mechanism and the modularization idea are overcome, and the design of the humanoid arm is carried out by adopting the idea of driving the joint module by the rope.
Disclosure of Invention
The invention aims to overcome the defects of the prior art and provide a rope-driven wrist module based on a three-degree-of-freedom series-parallel mechanism and a using method thereof, and the problems in the background art are solved by arranging a spherical pure rolling parallel mechanism and a tension amplifying mechanism.
In order to achieve the purpose, the invention provides the following technical scheme:
a rope driving wrist module based on a three-degree-of-freedom series-parallel mechanism comprises a three-degree-of-freedom series-parallel module and a driving and controlling integrated module which are arranged from top to bottom, wherein the three-degree-of-freedom series-parallel module consists of a parallel mechanism upper platform, a tension amplifying mechanism, a parallel mechanism lower platform, a rotary connecting table, a rope fixing screw, a three-degree-of-freedom series-parallel module shell, a bearing positioning sleeve, a motor fixedly connecting gear, a spherical pure rolling parallel mechanism, a deep groove ball bearing, a front end rope winding rotary drum, a thin gasket, a rear end rope winding rotary drum, a plug screw bearing and a motor transmission gear;
the upper platform of the parallel mechanism is connected with the lower platform of the parallel mechanism through a spherical pure rolling parallel mechanism and a tension amplifying mechanism, the spherical pure rolling parallel mechanism comprises three parallel mechanism connecting rods which are uniformly distributed along the circumferential direction at 120 degrees, and the three parallel mechanism connecting rods are bent and staggered, so that the upper platform of the parallel mechanism moves between-90 degrees and 90 degrees without interference;
the tension amplifying mechanism comprises an upper platform swing frame positioning block, a movable pulley, an upper platform swing frame, an upper platform rope retainer, a lower platform rope retainer, a fixed pulley, a lower platform swing frame, a rope reversing pin, a rope reversing bearing and a lower platform swing frame positioning block; the four tension amplifying mechanisms are uniformly distributed between the upper platform and the lower platform of the parallel mechanism along the circumferential direction by 90 degrees, and the tension and the rigidity are amplified in the two-degree-of-freedom motion direction through the movable pulley;
preferably, the deep groove ball bearing is positioned in the three-degree-of-freedom series-parallel module shell, and the lower platform of the parallel mechanism and the flange of the rotary connecting table are respectively embedded into the inner ring of the deep groove ball bearing and are connected with each other by screws; the front end rope winding rotary drum, the shim and the rear end rope winding rotary drum are sequentially sleeved in a cylinder on the bottom surface of the rotary connecting table and are axially positioned through a bearing positioning sleeve, two motor fixedly connecting gears are connected to the bearing positioning sleeve through a plug screw bearing and a plug screw, two motor transmission gears are respectively fixedly connected with the front end rope winding rotary drum and the rear end rope winding rotary drum through screws, and the bearing positioning sleeve is embedded into a three-degree-of-freedom serial-parallel module shell for positioning;
preferably, the spherical pure rolling parallel mechanism realizes the spherical motion with two degrees of freedom of the wrist, and the lower platform of the parallel mechanism has one degree of freedom of rotation, thereby forming a series-parallel mechanism;
preferably, the tension amplification factor of the tension amplification mechanism is two times, and the rigidity amplification factor is four times;
preferably, both ends of the connecting rod of the parallel mechanism are connected with the upper platform and the lower platform of the parallel mechanism through connecting rod fixing pins and connecting hinges;
preferably, the tension amplifying mechanism is respectively connected with the parallel mechanism upper platform and the parallel mechanism lower platform through an upper platform swing frame positioning block and a lower platform swing frame positioning block;
preferably, a rope transmission line of the tension amplifying mechanism enters from a rope fixing point through the lower platform swing frame and is reversed around the fixed pulley from the upper part, the rope enters the upper platform rope holder and the lower platform rope holder from bottom to top through the lower platform rope holder and the upper platform rope holder respectively, the rope is changed backwards through the sliding pulley and enters the lower platform rope holder and the upper platform rope holder respectively from top to bottom, the rope enters the lower platform swing frame positioning block through the rope reversing pin, the rope is transmitted to the front-end rope-winding rotary drum at the lower part through the rope reversing bearing, and the rope is wound along the front-end rope-winding rotary drum and is fixed at the groove through screws;
preferably, the drive control integrated module consists of a drive control integrated module shell and three small direct current motors, and the drive control integrated module shell is connected with the bearing positioning sleeve through screws; the surface of the driving and controlling integrated module shell is provided with a standard snap ring interface which is used for connecting with an elbow or other modules; the small direct current motors on the left side and the right side are provided with a reduction box and an encoder, the small direct current motors on the left side and the right side are used for driving the front-end rope winding rotary drum and the rear-end rope winding rotary drum to rotate through the motor fixedly connecting gear and the motor transmission gear, so that rope movement is realized, the small direct current motor in the middle is used for directly driving the rotary connecting table to rotate, and further, the three-degree-of-freedom series-parallel connection mechanism is realized to rotate;
preferably, after the middle small direct current motor drives the rotary connecting table to rotate by an angle theta, the small direct current motors on the left side and the right side set and drive the front end rope winding rotary drum and the rear end rope winding rotary drum to rotate by the angle theta through the encoders, and therefore rope coupling is solved.
The working process of the invention is as follows: when the rope winding machine is used, the small direct current motors on the left side and the right side drive the front end rope winding rotary drum and the rear end rope winding rotary drum to rotate through the motor fixedly connecting gear and the motor transmission gear, so that rope movement is realized, wherein delta r and delta p are the stretching amount of two pairs of ropes respectively; and the middle small direct current motor directly drives the rotating connecting table to rotate, so that the three-degree-of-freedom series-parallel connection mechanism integrally rotates. The invention uses the spherical pure rolling parallel mechanism to realize the inward bending, outward extending, ulnar side tilting and hand radial side tilting movement of the wrist, and uses the rotation of the rotary connecting platform to realize the freedom degree configuration of outward rotation and inward rotation of the wrist, but the rotation of the rotary connecting platform causes the change of delta r and delta p, namely the movement coupling exists; in order to solve the problem of rope coupling, after the middle direct current motor drives the rotary connecting table to rotate by an angle theta, the small direct current motors on the left side and the right side drive the front-end rope winding rotary drums and the rear-end rope winding rotary drums to rotate by the angle theta through setting of the encoders, and therefore rope coupling is solved.
Compared with the prior art, the invention has the beneficial effects that:
1. according to the invention, the connecting rods of the parallel mechanism are arranged in a bending and staggered manner, so that on one hand, interference between the connecting rods of the parallel mechanism is avoided in the motion process, the upper platform of the parallel mechanism can move between-90 degrees and +90 degrees without interference, and on the other hand, the parallel mechanism is hollow due to the staggered and bent design mode of the connecting rods of the parallel mechanism, so that the arrangement of a dexterous hand connected with the tail ends of the upper platform of the parallel mechanism in a module is facilitated, and the integration degree of the design of the humanoid robot is improved;
2. according to the invention, by arranging the tension amplification mechanism, the tension and rigidity amplification is carried out in the two-degree-of-freedom motion direction by adopting the principle of a movable pulley, the tension amplification factor is two times, and the rigidity amplification factor is four times, so that the mechanism is ensured to be light in weight and the rigidity is not lost;
3. according to the invention, the two-degree-of-freedom spherical motion of the wrist is realized through the spherical pure rolling parallel mechanism, and the lower platform of the parallel mechanism is designed to have a rotational degree of freedom, so that a series-parallel mechanism is formed; the spherical pure rolling parallel mechanism is used for realizing inward bending, outward extending, ulnar side tilting and hand radius side tilting movement of the wrist, the rotary connecting table is used for rotating to realize the freedom degree configuration of outward rotation and inward rotation of the wrist, the structure is simpler and more compact compared with the joint with the same freedom degree, the purpose of consistent configuration with the freedom degree of the wrist of a real person is achieved, and the spherical pure rolling parallel mechanism has good bionic property;
4. according to the invention, different motors are set to control different structures, after the middle small direct current motor drives the rotary connecting table to rotate by an angle theta, the small direct current motors on the left side and the right side set to drive the front end rope winding rotary drum and the rear end rope winding rotary drum to rotate by the angle theta through the encoders, so that the problem of rope coupling is solved, and the rotation accuracy of the invention is improved.
5. The invention is designed by combining the advantages of rope driving and modularization, and has the advantages of light weight, reconfigurability, good flexibility and the like.
Drawings
FIG. 1 is a schematic view of the overall structure of the present invention;
FIG. 2 is a schematic diagram of the connection between the three-degree-of-freedom series-parallel module and the driving and controlling integrated module according to the present invention;
FIG. 3 is an exploded view of the overall assembly structure of the present invention;
FIG. 4 is a schematic structural diagram of a three-degree-of-freedom serial-parallel hybrid mechanism according to the present invention;
FIG. 5 is a schematic diagram of the cable transmission path of the tension amplification mechanism of the present invention;
FIG. 6 is a schematic diagram of a two-degree-of-freedom spherical pure rolling parallel mechanism according to the present invention;
FIG. 7 is an overall drive analysis schematic of the present invention;
FIG. 8 is a schematic view of a rope coupling analysis of the present invention;
FIG. 9 is a schematic diagram of the configuration of the degrees of freedom and the range of motion of a real human wrist according to the present invention;
fig. 10 is a schematic diagram of the degree of freedom configuration of the serial-parallel serial mechanism of the present invention.
In the figure: A. the three-degree-of-freedom series-parallel module; B. a driving and controlling integrated module; 1. an upper platform of the parallel mechanism; 2. a tension amplifying mechanism; 3. a parallel mechanism lower platform; 4. rotating the connecting table; 5. a rope set screw; 6. a three-degree-of-freedom series-parallel module shell; 7. a bearing positioning sleeve; 8. the motor is fixedly connected with a gear; 9. a drive control integrated module housing; 10. a standard snap ring interface; 11. a spherical pure rolling parallel mechanism; 12. a deep groove ball bearing; 13. a front end rope-winding drum; 14. a shim; 15. a rear end rope-winding drum; 16. plugging and screwing screws; 17. plugging a screw bearing; 18. a motor transmission gear; 19. a small-sized DC motor; 20. an upper platform swing frame positioning block; 21. a movable pulley; 22. an upper platform swing frame; 23. an upper platform rope retainer; 24. a lower platform rope retainer; 25. a fixed pulley; 26. a lower platform swing frame; 27. a rope reversing pin; 28. a rope reversing bearing; 29. a lower platform swing frame positioning block; 30. a parallel mechanism connecting rod; 31. a connecting rod fixing pin; 32. a connecting hinge; 33. and fixing the screw groove.
Detailed Description
The present invention will be described in further detail with reference to examples and drawings, but the present invention is not limited thereto.
Referring to fig. 1-10, the present invention provides a technical solution:
the invention provides a rope-driven wrist module based on a three-degree-of-freedom series-parallel mechanism and a using method thereof, and the wrist module is composed of a three-degree-of-freedom series-parallel module A and a drive control integrated module B which are fixed through a shell side surface screw, so that the connection and the disassembly are convenient, as shown in figures 1 and 2.
The three-degree-of-freedom series-parallel module A is composed of a parallel mechanism upper platform 1, a tension amplifying mechanism 2, a parallel mechanism lower platform 3, a rotary connecting table 4, a rope fixing screw 5, a three-degree-of-freedom series-parallel module shell 6, a bearing positioning sleeve 7, a motor fixing gear 8, a spherical pure rolling parallel mechanism 11, a deep groove ball bearing 12, a front-end rope winding rotary drum 13, a thin gasket 14, a rear-end rope winding rotary drum 15, a plug screw 16, a plug screw bearing 17 and a motor transmission gear 18 as shown in FIG. 3;
the parallel mechanism upper platform 1 and the parallel mechanism lower platform 3 are connected with the tension amplifying mechanism 2 through a spherical pure rolling parallel mechanism 11, the spherical pure rolling parallel mechanism 11 comprises three parallel mechanism connecting rods 30 which are uniformly distributed along the circumferential direction at 120 degrees, and the three parallel mechanism connecting rods 30 are bent and staggered, so that the parallel mechanism upper platform 1 moves between-90 degrees and 90 degrees without interference
The deep groove ball bearing 12 is positioned in the three-degree-of-freedom series-parallel module shell 6, and the flanges of the lower platform 3 and the rotary connecting table 4 of the parallel mechanism are respectively embedded into the inner rings of the deep groove ball bearing 12 and are connected with each other by screws; the front-end rope-winding rotary drum 13, the shim 14 and the rear-end rope-winding rotary drum 15 are sequentially sleeved into a cylinder on the bottom surface of the rotary connecting table 4 and are axially positioned through a bearing positioning sleeve 7, two motor fixedly-connected gears 8 are connected to the bearing positioning sleeve 7 through a plug screw bearing 17 and a plug screw 16, two motor transmission gears 18 are respectively fixedly connected with the front-end rope-winding rotary drum 13 and the rear-end rope-winding rotary drum 15 through screws, and the bearing positioning sleeve 7 is embedded into the three-degree-of-freedom serial-parallel module shell 6 for positioning;
as shown in fig. 4, the tension amplification mechanism 2 is composed of an upper platform swing frame positioning block 20, a movable pulley 21, an upper platform swing frame 22, an upper platform rope retainer 23, a lower platform rope retainer 24, a fixed pulley 25, a lower platform swing frame 26, a rope reversing pin 27, a rope reversing bearing 28, and a lower platform swing frame positioning block 29. Four groups of tension amplification mechanisms 2 are uniformly distributed between an upper platform 1 and a lower platform 3 of the parallel mechanism along the circumferential direction by 90 degrees, every pair of the two groups of tension amplification mechanisms 2 is just opposite, the principle of a movable pulley 21 is adopted to amplify the tension and the rigidity in the two-degree-of-freedom motion direction, the tension amplification factor is two times, and the rigidity amplification factor is four times.
The tension amplification mechanism 2, as shown in FIG. 5, has a rope transmission path consisting of O1Starting, the rope enters from the left hole of the lower platform swing frame 26 and is reversed around the right fixed pulley 25 from the upper part, the rope passes through the left holes of the lower platform rope retainer 24 and the upper platform rope retainer 23 from bottom to top, is reversed by the movable pulley 21, enters the right holes of the upper platform rope retainer 23 and the lower platform rope retainer 24 from top to bottom, enters the left hole of the positioning block 29 of the lower platform swing frame through the rope reversing pin 27, is transmitted to the front end rope winding rotary drum 13 at the lower part by the rope reversing bearing 28, is wound along the front end rope winding rotary drum 13 and is fixed at the groove 33 by the screw, and the rope winding method is repeated after the other end is wound out from the right side of the front end rope winding rotary drum 13 until the rope reaches the O-shaped end of the other tension amplifying mechanism 22Wherein O is1And O2The rope fixing point of the platform 3 under the parallel mechanism is the same as that of the other two pairs of tension amplifying mechanisms 2.
The spherical pure rolling parallel mechanism 11, as shown in fig. 6, is composed of parallel mechanism connecting rods 30, connecting rod fixing pins 31 and connecting hinges 32. The spherical pure rolling parallel mechanism 11 is located at the center of the parallel mechanism upper platform 1 and the parallel mechanism lower platform 3, the joints of the parallel mechanism connecting rods 30 and the parallel mechanism upper platform 1 and the parallel mechanism lower platform 3 are arranged in a circumferential 120-degree mode, the parallel mechanism connecting rods 30 and the connecting hinges 32 are connected through connecting rod fixing pins 31, and similarly, the connecting hinges 32 are connected with the parallel mechanism upper platform 1 and the parallel mechanism lower platform 3 through the fixing pins 31.
As shown in FIG. 7, the spherical pure rolling parallel mechanism 11, on one hand, avoids interference between the parallel mechanism connecting rods 30 during movement, and the connecting rods are designed in a staggered bending mode, so that the parallel mechanism upper platform 1 can move between-90 degrees and +90 degrees without interference, and on the other hand, the parallel mechanism connecting rods 30 are designed in a staggered bending mode, so that the parallel mechanism is hollow, and the flexible hand connected with the tail ends of the parallel mechanism upper platform 1 can conveniently run in a module.
The driving and controlling integrated module B, as shown in fig. 8, is composed of a driving and controlling integrated module housing 9 and a small-sized dc motor 19. The driving and controlling integrated module shell 9 is connected with the bearing positioning sleeve 7 through four screws which are circumferentially arranged at 90 degrees at the tail end; the surface of the driving and controlling integrated module is provided with a standard snap ring interface 10 which is used for connecting with an elbow or other modules; the front ends and the tail ends of the three small direct current motors 19 are respectively provided with a reduction gearbox and an encoder, and the reduction gearbox is provided with two screw holes for connecting with the driving and controlling integrated module shell 9; the output shaft of the motor is a D-shaped shaft and can be connected with the D-shaped hole of the motor fixedly connecting gear 8 and the rotary connecting table 4 in a molded surface mode.
As shown in fig. 9, the small dc motors 19 on the left and right sides drive the front end rope-winding drum 13 and the rear end rope-winding drum 15 to rotate through the motor fixedly-connected gear 8 and the motor transmission gear 18, so as to realize rope movement, where Δ r and Δ p are the amounts of expansion of two pairs of ropes, respectively, and the middle small dc motor 19 directly drives the rotation connection platform 4 to rotate, so as to realize integral rotation of the mechanism shown in fig. 3, but rotation of the rotation connection platform 4 will cause Δ r and Δ p to change, i.e., there is kinematic coupling, as shown in fig. 8, in order to solve the problem of rope coupling, after the middle small dc motor 19 drives the rotation connection platform 4 to rotate by θ angle, the small dc motors 19 on the left and right sides need to drive the front end rope-winding drum 13 and the rear end rope-winding drum 15 to rotate by θ angle, correspondingly.
As shown in fig. 9, a real human wrist has three degrees of freedom, and each degree of freedom has a corresponding range of motion, 75 ° inflected/75 ° extended, 85 ° external/76 ° internal rotation, and 45 ° ulnar/20 ° hand radial roll, respectively. As shown in figure 10, the invention uses the spherical pure rolling parallel mechanism 11 to realize the two-degree-of-freedom spherical motion of the wrist, the lower platform 3 of the parallel mechanism has one degree of freedom of rotation, thereby forming a series-parallel mechanism, uses the spherical pure rolling parallel mechanism 11 to realize the inward bending, outward extending, ulnar side rolling and hand radial side rolling motion of the wrist, and uses the rotation of the rotary connecting table 4 to realize the degree-of-freedom configuration of the outward rotation and the inward rotation of the wrist, thereby achieving the purpose of being consistent with the degree-of-freedom configuration of the wrist of a real person.
The working process of the invention is as follows: when the rope winding machine is used, the small direct current motors 19 on the left side and the right side drive the front end rope winding rotary drum 13 and the rear end rope winding rotary drum 15 to rotate through the motor fixedly connecting gear 8 and the motor transmission gear 18, so that rope movement is realized, wherein delta r and delta p are the stretching amount of two pairs of ropes respectively; and the middle small direct current motor 19 directly drives the rotary connecting table 4 to rotate, so that the three-degree-of-freedom series-parallel connection mechanism integrally rotates. The invention uses the spherical pure rolling parallel mechanism 11 to realize the inward bending, outward extending, ulnar side rolling and hand radial side rolling movement of the wrist, uses the rotation of the rotary connecting platform 4 to realize the freedom degree configuration of outward rotation and inward rotation of the wrist, but the rotation of the rotary connecting platform 4 will cause the change of delta r and delta p, namely the movement coupling exists; in order to solve the problem of rope coupling, after the middle direct current motor drives the rotary connecting platform 4 to rotate by an angle theta, the small direct current motors 19 on the left side and the right side set to drive the front end rope winding rotary drum 13 and the rear end rope winding rotary drum 15 to rotate by the angle theta through the encoders, so that the rope coupling is solved.
The present invention is not limited to the above embodiments, and any other changes, modifications, substitutions, combinations, and simplifications which do not depart from the spirit and principle of the present invention should be construed as equivalents and are included in the scope of the present invention.
Claims (10)
1. A rope-driven wrist module based on a three-degree-of-freedom series-parallel mechanism is characterized by comprising a three-degree-of-freedom series-parallel module and a driving and controlling integrated module which are arranged from top to bottom, wherein the three-degree-of-freedom series-parallel module consists of a parallel mechanism upper platform, a tension amplifying mechanism, a parallel mechanism lower platform, a rotating connecting platform, a rope fixing screw, a three-degree-of-freedom series-parallel module shell, a bearing positioning sleeve, a motor fixedly connecting gear, a spherical pure rolling parallel mechanism, a deep groove ball bearing, a front-end rope winding rotary drum, a thin gasket, a rear-end rope winding rotary drum, a plug screw bearing and a motor;
the upper platform of the parallel mechanism is connected with the lower platform of the parallel mechanism through a spherical pure rolling parallel mechanism and a tension amplifying mechanism, the spherical pure rolling parallel mechanism comprises three parallel mechanism connecting rods which are uniformly distributed along the circumferential direction at 120 degrees, and the three parallel mechanism connecting rods are bent and staggered, so that the upper platform of the parallel mechanism moves between-90 degrees and 90 degrees without interference;
the tension amplifying mechanism comprises an upper platform swing frame positioning block, a movable pulley, an upper platform swing frame, an upper platform rope retainer, a lower platform rope retainer, a fixed pulley, a lower platform swing frame, a rope reversing pin, a rope reversing bearing and a lower platform swing frame positioning block; the four tension amplification mechanisms are uniformly distributed between the upper platform and the lower platform of the parallel mechanism along the circumferential direction by 90 degrees, and the tension and the rigidity are amplified in the two-degree-of-freedom motion direction through the movable pulley.
2. The rope-driven wrist module according to claim 1, wherein the deep groove ball bearing is positioned in a three-degree-of-freedom serial-parallel module housing, and flanges of the lower platform and the rotary connecting table of the parallel mechanism are respectively embedded in inner rings of the deep groove ball bearing and are connected with each other by screws; the front end rope winding rotary drum, the shim and the rear end rope winding rotary drum are sequentially sleeved into a cylinder on the bottom surface of the rotary connecting table and are axially positioned through a bearing positioning sleeve, two motor fixing gears are connected to the bearing positioning sleeve through a plug screw bearing and a plug screw, two motor transmission gears are respectively fixedly connected with the front end rope winding rotary drum and the rear end rope winding rotary drum through screws, and the bearing positioning sleeve is embedded into a three-degree-of-freedom serial-parallel module shell for positioning.
3. The rope-driven wrist module according to claim 2, wherein the spherical pure rolling parallel mechanism realizes a two-degree-of-freedom spherical motion of the wrist, and the platform of the parallel mechanism has a rotational degree of freedom, thereby forming a series-parallel hybrid mechanism.
4. The cord-driven wrist module of claim 1, wherein the tension amplification mechanism has a tension amplification factor of two times and a stiffness amplification factor of four times.
5. The cord-driven wrist module of claim 1, wherein the parallel mechanism links are connected at both ends to the parallel mechanism upper platform and the parallel mechanism lower platform by link fixing pins and connecting hinges.
6. The cord-driven wrist module of claim 1, wherein the tension amplifying mechanism is coupled to the parallel mechanism upper platform and the parallel mechanism lower platform via an upper platform swing frame locating block and a lower platform swing frame locating block, respectively.
7. The rope-driven wrist module according to claim 1, wherein the rope transmission path of the tension-amplifying mechanism starts from a rope-fixing point, enters from the lower platform swing frame and reverses around the fixed pulley from above, passes through the lower platform rope holder and the upper platform rope holder from bottom to top, respectively, passes through the lower platform rope holder and the upper platform rope holder, and through a sliding wheel and a rotating wheel, respectively, enters the upper platform rope holder and the lower platform rope holder from top to bottom, passes through a rope reversing pin, enters the lower platform swing frame positioning block, and is transmitted to the lower front-end rope-winding drum by the rope reversing bearing, and the rope is wound along the front-end rope-winding drum and is fixed at the groove by screws.
8. The cord-driven wrist module according to claim 1, wherein the drive and control integrated module is composed of a drive and control integrated module housing and three small direct current motors, the drive and control integrated module housing being in screw connection with the bearing positioning sleeve; the surface of the driving and controlling integrated module shell is provided with a standard snap ring interface which is used for connecting with an elbow or other modules; the small-size direct current motor is equipped with reducing gear box and encoder, and the small-size direct current motor of the left and right sides links firmly gear and motor drive gear through the motor and drives front end wiring rotary drum and rear end wiring rotary drum and rotate, and then realizes the rope motion, and the small-size direct current motor direct drive in the middle of rotates and connects the platform rotatory, and then realizes three degree of freedom series-parallel mechanism and rotates.
9. The cord-driven wrist module of claim 8, wherein the small dc motors on the left and right sides are configured to drive the front and rear cord reels to rotate through an angle θ via encoders after the intermediate small dc motor-driven rotary interface rotates through an angle θ, thereby resolving cord coupling.
10. Use of a three-degree-of-freedom serial-parallel-series mechanism-based rope-driven wrist module according to any one of claims 1 to 9, characterized by comprising the following steps:
when the rope winding machine is used, the small direct current motors on the left side and the right side drive the front end rope winding rotary drum and the rear end rope winding rotary drum to rotate through the motor fixedly connecting gear and the motor transmission gear, so that rope movement is realized, wherein delta r and delta p are the stretching amount of two pairs of ropes respectively; the middle small direct current motor directly drives the rotary connecting platform to rotate, so that the three-degree-of-freedom series-parallel mechanism is integrally rotated, the spherical pure rolling parallel mechanism is used for realizing inward bending, outward extending, ulnar side tilting and hand radius side tilting movement of a wrist, the rotary connecting platform is used for rotating to realize the freedom degree configuration of outward rotation and inward rotation of the wrist, but the rotation of the rotary connecting platform causes the change of delta r and delta p, namely, the motion coupling exists; in order to solve the problem of rope coupling, after the middle direct current motor drives the rotary connecting table to rotate by an angle theta, the small direct current motors on the left side and the right side drive the front-end rope winding rotary drums and the rear-end rope winding rotary drums to rotate by the angle theta through setting of the encoders, and therefore rope coupling is solved.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110360411.1A CN112894780B (en) | 2021-04-02 | 2021-04-02 | Rope-driven wrist module based on three-degree-of-freedom serial-parallel mechanism and application method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110360411.1A CN112894780B (en) | 2021-04-02 | 2021-04-02 | Rope-driven wrist module based on three-degree-of-freedom serial-parallel mechanism and application method thereof |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112894780A true CN112894780A (en) | 2021-06-04 |
CN112894780B CN112894780B (en) | 2024-06-18 |
Family
ID=76109855
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110360411.1A Active CN112894780B (en) | 2021-04-02 | 2021-04-02 | Rope-driven wrist module based on three-degree-of-freedom serial-parallel mechanism and application method thereof |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112894780B (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113977627A (en) * | 2021-12-24 | 2022-01-28 | 季华实验室 | Flexible joint and robot |
CN114083566A (en) * | 2021-12-23 | 2022-02-25 | 杭州电子科技大学 | Rigid-flexible coupling type robot wrist joint |
CN115107014A (en) * | 2022-08-10 | 2022-09-27 | 北京航空航天大学 | Rope drive elbow wrist joint module, arm and robot |
WO2024087920A1 (en) * | 2022-10-25 | 2024-05-02 | 深圳技术大学 | Rope-driven operation handle |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109176491A (en) * | 2018-10-29 | 2019-01-11 | 哈尔滨工业大学(深圳) | A kind of single-degree-of-freedom module that rope drives and the multiple-degree-of-freedom mechanism using it |
US20190160653A1 (en) * | 2016-07-26 | 2019-05-30 | Arizona Board Of Regents On Behalf Of Arizona State University | Mechanism for alleviating the effects of joint misalignment between users and wearable robots |
CN110202559A (en) * | 2019-06-28 | 2019-09-06 | 华南理工大学 | One kind is towards the bionical lightweight mechanical arm of man-machine collaboration |
CN110666775A (en) * | 2019-09-23 | 2020-01-10 | 广东工业大学 | Two-degree-of-freedom rope-driven swinging and rotating parallel mechanism |
CN110666774A (en) * | 2019-09-23 | 2020-01-10 | 广东工业大学 | Three-degree-of-freedom rope driving joint module based on parallel mechanism |
CN110666833A (en) * | 2019-09-23 | 2020-01-10 | 广东工业大学 | Rope-driven seven-degree-of-freedom humanoid mechanical arm based on parallel mechanism |
US20200039091A1 (en) * | 2016-10-06 | 2020-02-06 | Université de Franche-Comté | Robotic structure with six degrees of freedom allowing gripping |
CN214724204U (en) * | 2021-04-02 | 2021-11-16 | 广东工业大学 | Rope-driven wrist module based on three-degree-of-freedom serial-parallel hybrid mechanism |
-
2021
- 2021-04-02 CN CN202110360411.1A patent/CN112894780B/en active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20190160653A1 (en) * | 2016-07-26 | 2019-05-30 | Arizona Board Of Regents On Behalf Of Arizona State University | Mechanism for alleviating the effects of joint misalignment between users and wearable robots |
US20200039091A1 (en) * | 2016-10-06 | 2020-02-06 | Université de Franche-Comté | Robotic structure with six degrees of freedom allowing gripping |
CN109176491A (en) * | 2018-10-29 | 2019-01-11 | 哈尔滨工业大学(深圳) | A kind of single-degree-of-freedom module that rope drives and the multiple-degree-of-freedom mechanism using it |
CN110202559A (en) * | 2019-06-28 | 2019-09-06 | 华南理工大学 | One kind is towards the bionical lightweight mechanical arm of man-machine collaboration |
CN110666775A (en) * | 2019-09-23 | 2020-01-10 | 广东工业大学 | Two-degree-of-freedom rope-driven swinging and rotating parallel mechanism |
CN110666774A (en) * | 2019-09-23 | 2020-01-10 | 广东工业大学 | Three-degree-of-freedom rope driving joint module based on parallel mechanism |
CN110666833A (en) * | 2019-09-23 | 2020-01-10 | 广东工业大学 | Rope-driven seven-degree-of-freedom humanoid mechanical arm based on parallel mechanism |
CN214724204U (en) * | 2021-04-02 | 2021-11-16 | 广东工业大学 | Rope-driven wrist module based on three-degree-of-freedom serial-parallel hybrid mechanism |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114083566A (en) * | 2021-12-23 | 2022-02-25 | 杭州电子科技大学 | Rigid-flexible coupling type robot wrist joint |
CN113977627A (en) * | 2021-12-24 | 2022-01-28 | 季华实验室 | Flexible joint and robot |
CN113977627B (en) * | 2021-12-24 | 2022-03-08 | 季华实验室 | Flexible joint and robot |
CN115107014A (en) * | 2022-08-10 | 2022-09-27 | 北京航空航天大学 | Rope drive elbow wrist joint module, arm and robot |
WO2024087920A1 (en) * | 2022-10-25 | 2024-05-02 | 深圳技术大学 | Rope-driven operation handle |
Also Published As
Publication number | Publication date |
---|---|
CN112894780B (en) | 2024-06-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112894780A (en) | Rope-driven wrist module based on three-degree-of-freedom series-parallel mechanism and using method thereof | |
US8234949B2 (en) | Power transmission mechanism and robot arm using the same | |
CN112476478B (en) | Bionic rope-driven four-degree-of-freedom arm oriented to man-machine cooperation | |
CN110154045B (en) | Flexible cable-driven series-connection four-degree-of-freedom spraying mechanical arm | |
US8511197B2 (en) | Robot arm assembly | |
CN110666774B (en) | Three-degree-of-freedom rope driving joint module based on parallel mechanism | |
WO1984004269A1 (en) | Articulated arm type of industrial robot | |
CN103732951A (en) | Composite drive device and robot | |
CN214724204U (en) | Rope-driven wrist module based on three-degree-of-freedom serial-parallel hybrid mechanism | |
CN106037934A (en) | Surgical robot and mechanical arm thereof | |
CN212146413U (en) | Desktop-level six-axis cooperative robot | |
CN110561489A (en) | Three-degree-of-freedom parallel driving joint | |
CN117921736A (en) | Reconfigurable mechanical arm based on variable stiffness joint | |
KR101947697B1 (en) | Parallel actuator with 4-dof | |
CN205835329U (en) | Modularity rope drives decoupling joint of mechanical arm | |
CN112975911A (en) | Two-translation freedom parallel mechanism | |
CN115890629A (en) | Bionic mechanical arm based on three parallel spherical joints | |
TW201217124A (en) | Robot arm assembly | |
CN113733154B (en) | Flexible mechanical arm based on cross shaft hinge | |
CN105798947A (en) | Reconfigurable rope-driven tandem decoupling mechanical arm joint and working method thereof | |
CN104476566A (en) | Three-branch and six-degree-of-freedom parallel mechanism with rope-driven joint | |
CN111360786B (en) | Seven-degree-of-freedom serial-parallel hybrid mechanical arm configuration and mechanical arm | |
CN112026951B (en) | Multi-legged robot with modular tensioning overall structure | |
CN205704261U (en) | Reconfigurable rope drives series connection decoupling mechanical arm revolute joint and elevation rotary joint | |
CN105798899A (en) | Modular rope-driven decoupling mechanical arm joint and working method thereof |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |