Description of drawings
Fig. 1 is the structure chart of tetrahedral rolling robot of the present invention.
Fig. 2 is the structure chart of first node board component of the present invention.
Fig. 3 is the structure chart of A telescopic arm of the present invention.
Fig. 3 A is the exploded view of A telescopic arm of the present invention.
Fig. 3 B is the structure chart of A connector of the present invention.
Fig. 3 C is the structure chart of base of the present invention.
Fig. 3 D is another visual angle structure chart of base of the present invention.
Fig. 3 E is the structure chart of B connector of the present invention.
Fig. 3 F is the structure chart of D connector of the present invention.
Fig. 3 G is the structure chart of E connector of the present invention.
Fig. 3 H is the structure chart of A pulley assembly of the present invention.
Fig. 3 I is the structure chart of baffle plate in the A pulley assembly of the present invention.
Fig. 3 J is the structure chart of A pulley base in the A pulley assembly of the present invention.
Fig. 3 K is the structure chart of A pulley spindle in the A pulley assembly of the present invention.
Fig. 3 L is the structure chart of D pulley assembly of the present invention.
Fig. 3 M is the structure chart of D pulley base in the D pulley assembly of the present invention.
Fig. 4 is the installation diagram of pulley of the present invention and cotton rope.
Among the figure: 1.A telescopic arm 11.A sleeve 12.B sleeve 13.C sleeve
14.A pulley assembly 14a.A pulley 141.A pulley base 1411. installed surface 1412.B support arms
1413.A support arm 1414.J through hole 1415.K through hole 142.A baffle plate 1421.A support arm
1422.B support arm 1423. screwed hole 1424.I through hole 143.A pulley spindles 1431. thread segments
1432. pulley segment 15.B pulley assembly 15a.B pulley 16.C pulley assembly 16a.C pulley
17.D pulley assembly 17a.D pulley 17b.E pulley 171.B baffle plate 172.D pulley base
1721. dividing plate 1722.C cavity 1723.D cavity 1724.A lateral plates 1725.B lateral plates
1726. back plate face 1727. base plate face 172a.J through hole 172b.K through holes 173. pins
174.B pulley spindle 175.C pulley spindle 101.A connector 1011. lug 1012.A through holes
1013.B through hole 101 4.A chute 1015.B chute 1016.A plate face 1017.B plate faces
1018.C plate face 102.B connector 1021.C chute 1022.A plate face 103.C connector
1031.U shape is pitched 1032. cylinder links, 104. bases, 1041. upper faces
1042. boss 1043.C through hole 1044. base plate face 1045.D through hole 1046.A cavitys
1047.B cavity 105.D connector 1051.D plate face 1052.C plate face 1053.B plate face
1054.D chute 1055.E through hole 1056.F through hole 1057.E chute 1058.F chute
106.E connector 1061.G chute 1062.G through hole 1063.H through hole 1064. transverse slats
1065.A plate face 107. lines wheel 107a. central through hole 107b.A wire casing 107c.B wire casing
2.B telescopic arm 3.C telescopic arm 4.D telescopic arm 5.E telescopic arm 6.F telescopic arm
1a.AB section cotton rope 1b.CD section cotton rope 1c.EF section cotton rope 1d.GH section cotton rope
7. first node board component 7a.A universal joint 7a-1.A pin-and-hole 7b.B universal joint
7b-1.B pin-and-hole 7c.C universal joint 7c-1.C pin-and-hole 74.A gusset plate 741. base plate faces
8. Section Point board component 8a.D universal joint 8b.E universal joint 8c.F universal joint
9. the 3rd gusset plate assembly 9a.G universal joint 9b.H universal joint 9c.I universal joint
10. the 4th gusset plate assembly 10a.J universal joint 10c.L universal joint
1 1A.A motor 12B.B motor 13C.C motor 14D.D motor 16F.F motor
The specific embodiment
The present invention is described in further detail below in conjunction with accompanying drawing.
The motion mode of the tetrahedral rolling robot of the present invention's design is different with traditional mobile robot, and conventional machines people need rely on bracing or strutting arrangement (wheel, crawler belt, polypody walking leg etc.) to advance, and will guarantee the stability of robot, can not tumble.And having utilized the characteristics of tumbling after the tetrahedron unstability to roll just, the motion mode of tetrahedral rolling robot of the present invention advances.
Referring to Fig. 1, Fig. 2, shown in Figure 3, a kind of tetrahedral rolling robot of the present invention with parallel institution, be to constitute by six roots of sensation telescopic arm and four gusset plate assemblies, described each gusset plate assembly is made up of gusset plate and three universal joints, and three universal joints are the equilateral triangle layout on the base plate face of gusset plate.
In the present invention, the structure of six roots of sensation telescopic arm is identical, and adopts the rope type of drive.Six roots of sensation telescopic arm is meant A telescopic arm 1, B telescopic arm 2, C telescopic arm 3, D telescopic arm 4, E telescopic arm 5 and F telescopic arm 6.The two ends of each telescopic arm are connected on the universal joint of two gusset plate assemblies.
In the present invention, the structure of four gusset plate assemblies is identical, and four gusset plate assemblies are meant first node board component 7, Section Point board component 8, the 3rd gusset plate assembly 9 and the 4th gusset plate assembly 10.Three universal joints in each gusset plate assembly are connected with an end of three telescopic arms respectively.
In the present invention, motor is chosen DC servo motor, and its output minimum power is 100W.A motor 11A is used for 107 motions of drive wire wheel, thereby makes that connecting online rope of taking turns moves.Cooperation robot of the present invention by cotton rope, line wheel, pulley and motor can change forms of motion to adapt to different environment, has bigger kinematic dexterity, abundant forms of motion makes this robot can face various types of obstacles calmly, and need not consider the problem of stability.
Referring to Fig. 3, Fig. 3 A, shown in Figure 4, A telescopic arm 1 has adopted the nested mode of three sleeves, i.e. the outside socket B sleeve 12 of C sleeve 13, and 11, three sleeves of outside socket A sleeve of B sleeve 12 adopt tetragonal hollow aluminum section bar.
A connector 101, A sleeve 11 and base 104 form the first segment arm.The F end of EF section cotton rope 1c is connected on the A connector 101.
B connector 102, B sleeve 12 and D connector 105 form the second joint arm.The B end of AB section cotton rope 1a is connected on the D connector 105.
C connector 103, C sleeve 13 and E connector 106 form the 3rd joint arm.The E end of EF section cotton rope 1c is connected on the E connector 106.
Line wheel 107 is connected on the output shaft of A motor 11A, is connected with the A end of AB section cotton rope 1a and the C end of CD section cotton rope 1b on the line wheel 107.
The first segment arm is motionless with respect to the second joint arm, and A motor 11A drives the second joint arm motion, and the motion with the second joint arm drives the 3rd joint arm 1c motion as power source thus, thereby realizes the flexible of the second joint arm, the 3rd joint arm.The present invention has utilized just changeing, reversing to make and twine the online motion of taking turns the cotton rope receipts weak point on 107 or lengthening the realization second joint arm, the 3rd joint arm of A motor 11A.
Shown in Fig. 1, Fig. 3, Fig. 3 A~Fig. 3 M, the concrete structure of A telescopic arm 1 is:
A telescopic arm 1 includes A sleeve 11, B sleeve 12, C sleeve 13, a plurality of connector and rope driven unit; The rope driven unit includes A motor 11A, AB section cotton rope 1a, CD section cotton rope 1b, EF section cotton rope 1c, GH section cotton rope 1d, A pulley assembly 14, B pulley assembly 15, C pulley assembly 16, D pulley assembly 17, line wheel 107; Wherein, A pulley assembly 14, B pulley assembly 15 are identical with the structure of C pulley assembly 16.
(1) the A sleeve 11
The upper end of A sleeve 11 is connected with A connector 101, and the lower end of A sleeve 11 is connected with base 104;
Shown in Fig. 3 B, A connector 101 part that is formed in one.
The upper end of the A plate face 1016 of A connector 101 is provided with lug 1011, and lug 1011 is provided with A through hole 1012, and the G end that this A through hole 1012 is used for GH section cotton rope 1d passes, and knotting, thereby the G end of realizing GH section cotton rope 1d is connected with the lug 1011 of A connector 101.
The inwall of the B plate face 1017 of A connector 101 is provided with A chute 1014, and the end face of A chute 1014 to B plate faces 1017 is provided with B through hole 1013, the F end that this B through hole 1013 is used for EF section cotton rope 1c is passed to B through hole 1013 by A chute 1014, and knotting, thereby being connected of the B plate face 1017 of the F end of realizing EF section cotton rope 1c and A connector 101.A chute 1014 is used for EF section cotton rope 1c and slides up and down within it, and semicircular chute has guaranteed that EF section cotton rope 1c only slides in chute, and 1c plays spacing effect to EF section cotton rope.
The inwall of the C plate face 1018 of A connector 101 is provided with B chute 1015, and this B chute 1015 is used for AB section cotton rope 1a and slides up and down within it, and semicircular chute has guaranteed that AB section cotton rope 1a only slides in chute, and 1a plays spacing effect to AB section cotton rope.
Shown in Fig. 3 C, Fig. 3 D, base 104 is a hollow structural component, promptly is provided with B cavity 1047, and an end of this B cavity 1047 is equipped with D pulley assembly 17, and other end installation is wired takes turns 107.
The upper face 1041 of base 104 is provided with C through hole 1043 and boss 1042; The output shaft that C through hole 1043 is used for A motor 11A is connected with line wheel 107 by the back, and is installed in C through hole 1043 places of upper face 1041 by three screwed holes that are located at C through hole 1043 outer rims with making A motor 11A cooperating of screw.Be provided with A cavity 1046 in the boss 1042, this A cavity 1046 is used to install C pulley assembly 16.Boss 1042 is used for being connected with the lower end of A sleeve 11.The base plate face 1044 of base 104 is provided with D through hole 1045, and the pin that this D through hole 1045 is used for D pulley assembly 17 passes the back and is connected with the pin-and-hole of D universal joint 81, thus being connected of realization A telescopic arm 1 and Section Point board component 8.
(2) the B sleeve 12
The upper end of B sleeve 12 is connected with B connector 102, and the lower end of B sleeve 12 is connected with D connector 105;
Shown in Fig. 3 E, the inwall of the A plate face 1022 of B connector 102 is provided with C chute 1021, this C chute 1021 is used for GH section cotton rope 1d and slides up and down within it, and semicircular chute has guaranteed that GH section cotton rope 1d only slides in chute, and 1d plays spacing effect to GH section cotton rope.
Shown in Fig. 3 F, the D plate face 1051 of D connector 105 is provided with F chute 1058, and the upper surface of these F chute 1058 to D connectors 105 is provided with F through hole 1056, and the D end that this F through hole 1056 is used for CD section cotton rope 1b passes, and knotting, thereby realize the D end of CD section cotton rope 1b and being connected of D connector 105.This F chute 1058 is used for CD section cotton rope 1b and slides up and down within it, and semicircular chute has guaranteed that CD section cotton rope 1b only slides in chute, and 1b plays spacing effect to CD section cotton rope.
The C plate face 1052 of D connector 105 is provided with E chute 1057, the upper surface of these E chute 1057 to D connectors 105 is provided with E through hole 1055, the B end that this E through hole 1055 is used for AB section cotton rope 1a passes, and knotting, thereby realizes the B end of AB section cotton rope 1a and being connected of D connector 105.This E chute 1057 is used for AB section cotton rope 1a and slides up and down within it, and semicircular chute has guaranteed that AB section cotton rope 1a only slides in chute, and 1a plays spacing effect to AB section cotton rope.
The B plate face 1053 of D connector 105 is provided with D chute 1054, and this D chute 1054 is used for EF section cotton rope 1c and slides up and down within it, and semicircular chute has guaranteed that EF section cotton rope 1c only slides in chute, and 1c plays spacing effect to EF section cotton rope.
(3) the C sleeve 13
The upper end of C sleeve 13 is connected with C connector 103, and the lower end of C sleeve 13 is connected with E connector 106;
As shown in Figure 3A, one end of C connector 103 is a cylinder link 1031, the other end is a U-shaped fork 1032, U-shaped fork 1032 is connected the upper end of C sleeve 13, the A pin-and-hole 7a-1 of A universal joint 7a in cylinder link 1031 and the first node board component 7 is connected, thereby realizes the upper end of A telescopic arm 1 and being connected of first node board component 7.
Shown in Fig. 3 G, E connector 106 is provided with transverse slat 1064, and is provided with H through hole 1063 on transverse slat 1064, and the E end that this H through hole 1063 is used for EF section cotton rope 1c passes, and knotting, thereby realizes the E end of EF section cotton rope 1c and being connected of E connector 106.
The A plate face 1065 of E connector 106 is provided with D chute 1061, the upper surface of these D chute 1061 to E connectors 106 is provided with G through hole 1062, the H end that this G through hole 1062 is used for GH section cotton rope 1d passes, and knotting, thereby realizes the H end of GH section cotton rope 1d and being connected of E connector 106.
(4) the A pulley assembly 14
Shown in Fig. 3 H, Fig. 3 I, Fig. 3 J, Fig. 3 K, A pulley assembly 14 includes pulley base 141, baffle plate 142, pulley spindle 143 and pulley 144,
The upper end of pulley base 141 is provided with A support arm 1413 and B support arm 1412, and A support arm 1413 is provided with K through hole 1415, and B support arm 1412 is provided with J through hole 1412.Pulley base 141 is installed in A pulley assembly 14 by installed surface 1411 upper end of B sleeve 12.
Baffle plate 142 is provided with A support arm 1421 and B support arm 1422, and A support arm 1421 is provided with screwed hole 1423, and B support arm 1422 is provided with I through hole 1424.
Pulley spindle 143 is provided with pulley segment 1432, thread segment 1431.
The installation that A pulley assembly 14 is realized between pulley base 141, baffle plate 142 and the pulleys 144 by pulley spindle 43, promptly the thread segment 1431 of pulley spindle 143 passes I through hole 1424, J through hole 1414, pulley 144, K through hole 1415 rear threads in turn and is connected on the screwed hole 1423.
(5) the D pulley assembly 17
Shown in Fig. 3 A, Fig. 3 L, Fig. 3 M, D pulley assembly 17 includes D pulley 17a, E pulley 17b, B pulley spindle 174, C pulley spindle 175, B baffle plate 171, D pulley base 172, pin 173;
D pulley base 172 is separated into two cavitys by dividing plate 1721, i.e. C cavity 1722, D cavity 1723, and C cavity 1722 is used to place D pulley 17a, and D cavity 1723 is used to place E pulley 17b;
The back plate face 1726 of D pulley base 172 is provided with J through hole 172a;
The base plate face 1727 of D pulley base 172 is provided with K through hole 172b, and this K through hole 172b is used for pin 173 to be passed through, and the link of pin 173 is connected in the pin-and-hole of D universal joint 8a;
D pulley 17a is installed between the A lateral plates 1724 and dividing plate 1721 of D pulley base 172 by B pulley spindle 174;
E pulley 17b is installed between the B lateral plates 1725 and dividing plate 1721 of D pulley base 172 by C pulley spindle 175;
One end of B baffle plate 171 is installed on the B lateral plates 1725, and coaxial with an end of C pulley spindle 175, and the other end of B baffle plate 171 is installed on the dividing plate 1721, and coaxial with the other end of C pulley spindle 175;
In the present invention, four sections cotton ropes (AB section cotton rope 1a, CD section cotton rope 1b, EF section cotton rope 1c, GH section cotton rope 1d) with the canoe of four pulley assemblies (A pulley assembly 14, B pulley assembly 15, C pulley assembly 16, D pulley assembly 17) are:
When A motor 11A clockwise direction rotates, the A of AB section cotton rope 1a end online the wheel on 107 the A wire casing 107a that be connected, behind B pulley 15a and D pulley 17a, the B end of AB section cotton rope 1a is connected on the D connector 105 (D connector 105 is connected with the lower end of B sleeve 12), thereby realizes the elongation of second level arm; The G end of GH section cotton rope 1d is connected with A connector 101 (A connector 101 is connected with the upper end of A sleeve 11) and connects, H end through GH section cotton rope 1d behind the E pulley 17b connects with E connector 106 (E connector 106 is connected with the lower end of C sleeve 13), thereby realizes the elongation of third level arm.
When A motor 11A counterclockwise rotates, the C of CD section cotton rope 1b end online the wheel on 107 the B wire casing 107b that be connected, through being connected behind the A pulley 14a on the D connector 105 (D connector 105 is connected with the lower end of B sleeve 12), thus the arm shortening of the realization second level; The F of EF section cotton rope 1c end is connected on the A connector 101 (A connector 101 is connected with the upper end of A sleeve 11), through being connected behind the C pulley 16a on the E connector 106 (E connector 106 is connected with the lower end of C sleeve 13), thus the shortening of realization third level arm.
Referring to Fig. 1, shown in Figure 2, the concrete structure of first node board component 7 is:
First node board component 7 includes A gusset plate 74, A universal joint 7a, B universal joint 7b, C universal joint 7c composition; A universal joint 7a, B universal joint 7b and C universal joint 7c install according to positive angular distribution on base plate face 741.
The end of A universal joint 7a is installed on the base plate face 741 of A gusset plate 74, and the other end of A universal joint 7a is connected on the cylinder link 1031 of C connector 103 of A telescopic arm 1;
The end of B universal joint 7b is installed on the base plate face 741 of A gusset plate 74, and the other end of B universal joint 7b is connected on the cylinder link of C connector of B telescopic arm 1;
The end of C universal joint 7c is installed on the base plate face 741 of A gusset plate 74, and the other end of C universal joint 7c is connected on the cylinder link of C connector of C telescopic arm 3.
In the present invention, because Section Point board component 8, the 3rd gusset plate assembly 9, the 4th gusset plate assembly 10 are identical with the structure of first node board component 7, so the annexation of the annexation of Section Point board component 8, the 3rd gusset plate assembly 9, the 4th gusset plate assembly 10 and first node board component 7 and A telescopic arm 1 is identical.
Because robot of the present invention has adopted modular parts design, therefore, according to the structure explanation of A telescopic arm 1 and first node board component 7, can derive obtains the structure and the annexation of its excess-three telescopic arm, three gusset plate assemblies.That is:
A universal joint 7a in the first node board component 7 is connected with the cylinder link 1031 of the C connector 103 of A telescopic arm 1, and the pin 173 of the D pulley assembly 17 of A telescopic arm 1 is connected on the D universal joint 8a in the Section Point board component 8.
B universal joint 7b in the first node board component 7 is connected with the cylinder link of the C connector of B telescopic arm 2, and the pin of the D pulley assembly of B telescopic arm 2 is connected on the G universal joint 9a in the 3rd gusset plate assembly 9.
C universal joint 7c in the first node board component 7 is connected with the cylinder link of the C connector of C telescopic arm 3, and the pin of the D pulley assembly of C telescopic arm 3 is connected on the J universal joint 10a in the 4th gusset plate assembly 10.
E universal joint 8b in the Section Point board component 8 is connected with the cylinder link of the C connector of D telescopic arm 4, and the pin of the D pulley assembly of D telescopic arm 4 is connected on the K universal joint (not shown in figure 1) in the 4th gusset plate assembly 10.
F universal joint 8c in the Section Point board component 8 is connected with the cylinder link of the C connector of E telescopic arm 5, and the pin of the D pulley assembly of E telescopic arm 5 is connected on the H universal joint 9b in the 3rd gusset plate assembly 9.
L universal joint 10c in the 4th gusset plate assembly 10 is connected with the cylinder link of the C connector C connector of F telescopic arm 6, and the pin of the D pulley assembly of F telescopic arm 6 is connected on the I universal joint 9c in the 3rd gusset plate assembly 9.
A motor 11A is installed on the base 104 of A telescopic arm 1;
B motor 12B is installed on the base of B telescopic arm 2;
C motor 13C is installed on the base of C telescopic arm 3;
D motor 14D is installed on the base of D telescopic arm 4;
E motor 15E is installed on the base of E telescopic arm 5;
F motor 16F is installed on the base of F telescopic arm 6.
In order to guarantee that universal joint can satisfy the requirement that the telescopic arm pose changes fully, the present invention adopts the universal joint that possesses two frees degree to be connected with telescopic arm, thereby realizes relatively rotating of telescopic arm.
The tetrahedral rolling robot of the present invention's design is in motion process, and the six roots of sensation telescopic arm of tetrahedral rolling robot is flexible according to certain rule, and tetrahedral shape changes, position of centre of gravity becomes thereupon, when center of gravity surmounted its stability region, tetrahedron robot unstability was rolled.Tetrahedral shape constantly changes according to a certain rule, as long as satisfy instability condition, just can realize that continuous rolling advance.By adjusting the forms of motion (number of expansion link, the speed ratio of telescopic arm, acceleration ratio etc.) of six roots of sensation telescopic arm, can realize the different gaits of tetrahedral rolling robot.