SPRING-SUPPORT MECHANISM FOR PARALLEL ROBOTS

Abstract

The purpose of the presented invention propose a spring-support mechanism for the parallel robot, and this mechanism is applied to parallel robot models to reduce the load on the actuators. The spring-support mechanism for the parallel robot are composed of: sets of rotated joints to adjust the direction of the support mechanism to match the direction of the moving frame of robot, rhombus mechanism with hinges in four vertices transform displacement of moving frame to elasticity of springs, guiding plates used to adjust the springs length so that the thrust force generated by springs is constant, set of springs is assembled parallel and fixtures for the springs.

Claims

1. The spring-support mechanism for a parallel robot comprising: Sets of rotated joints to adjust the direction of the support mechanism to match a direction of a moving frame of the robot; Rhombus mechanism with hinges in four vertices for transforming a displacement of the moving frame to an elasticity of springs, said springs having a length; Guiding plates used to adjust the length of the springs so that a thrust force generated by the springs is constant; wherein The set of springs is assembled parallel, and Comprising fixtures for the springs.

2. The spring-support mechanism for parallel robot with constant force according to claim 1: When the moving frame moves down, the spring are compressed and a length of the structure decreases; Then the rhombus structure will be flattened, The movement of the rhombus is passed to the guiding plates through pivots, When the rhombus is compressed, the pivots touch the guiding plates and move them apart, wherein the guiding plates are provided with guiding grooves, these grooves adjust the displacement of the locating pivots on the rhombus to the displacement of the spring such that the rhombus's thrust force is constant.

3. The spring-support mechanism for parallel robot with constant force according to claim 1, wherein: When the spring-support mechanism transpose a difference d.sub.z, so two pivots transpose a difference d.sub.thoi, then two pivots slide on the grooves and the guiding plate displaces the spring a difference d.sub.lx, When a compression force F.sub.load is applied to the support mechanism, F.sub.tx impact on the flange of the guiding plate to balance with the F.sub.load, Consequently, the spring generate a elastic force F.sub.elastic to balance with the F.sub.tx.

4. The spring-support mechanism for parallel robot with constant force according to claim 1, wherein: Appling principle of virtual work to this structure, we have following formulation:
F.sub.elasticd.sub.spring=F.sub.loadd.sub.z F.sub.elastic: the elastic force of the springs; F.sub.load: the force of the load impact on the support mechanism; d.sub.spring: differential displacement of springs (total displacement due to rhombus structure and adjustment of guiding groove); d.sub.z: The differential displacement of the moving frame; d.sub.spring is calculated by the following formula:
d.sub.spring=d.sub.thombus+d.sub.groove d.sub.thombus differential displacement of pivots (14), depends on the texture, length of the edges of the rhombus; d.sub.groove differential displacement of trajectory of grooves; F.sub.load is gravity value of the load, for d.sub.z is the displacement of moving frame of robot, d.sub.thombus will be a function of d.sub.z when we give the length of the edge, and the position of pivot (14), and a condition x.sub.spring(0)=z(0)=0 we can calculate the trajectory of grooves d.sub.groove (26), (28).

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0012] FIG. 1: 3 degree of freedom robot with a direct support spring;

[0013] FIG. 2: 6 degree of freedom robot is supported by springs with constant force;

[0014] FIG. 3: a spring-support mechanism generates constant force;

[0015] FIG. 4: a rhombus structure;

[0016] FIG. 5: a rhombus structure and two guiding plates;

[0017] FIG. 6: a left-side guiding plate;

[0018] FIG. 7: a right-side guiding plate;

[0019] FIG. 8: cluster of upper rotated joints;

[0020] FIG. 9: cluster of lower rotated joints;

[0021] FIG. 10: cluster of spring-fixtures and guide plates;

[0022] FIG. 11: the left-spring-fixture;

[0023] FIG. 12: the right-spring-fixture;

[0024] FIG. 13: the spring-fixtures (flat projection);

[0025] FIG. 14a and FIG. 14b illustrate the principle of the reciprocal motion of the support structure (1);

[0026] FIG. 15a and FIG. 15b illustrate the principle of the reciprocal motion of the support structure (2);

[0027] FIG. 16: the balance of load and elastic force (1); and

[0028] FIG. 17: the balance of load and elastic force (2).

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENT

[0029] The spring-support mechanism (4) generates a constant force that is integrated into the parallel robot system as shown in FIGS. 1, 2 and 3, cluster of upper rotated joints (5) of the support mechanism accompany with the moving frame (3) of the robot, a cluster of lower rotated joints (9) is fixed to the ground. The support mechanism is likely a 7th actuator that always generates a constant force in the workspace of the robot to balance the gravity of the load. The spring-support mechanism for parallel robot with constant force consists of the following components:

[0030] Clusters of rotated joints: refer to FIGS. 8 and 9, the cluster of upper rotated joints (5) consisting of three rotated joints, including the x-axis rotated joint (19), the y-axis rotated joint (18), the z-axis rotated joint (17) and on the z-axis rotated joint with a flanged surface (23) to connect to the robot's moving frame. The cluster of lower rotated joints (9) consists of two rotated joints, including the x-axis rotated joint (20), the y-axis rotated joint (21) and the flanged surface (22) to connect to the ground. Because the moving frame of the 6 degree of freedom robot can move in three directions x, y, z and rotate three angles around the x, y, and z axes, so the actuators need rotated joints at the both end to not constrain the degree of freedom of robot, similar to actuators which also has a three-axis joints at the top connected to the moving frame and two-axis joints on the bottom connected to the ground. Rotated joint is hinge, which uses bushings or needle roller bearings because of the high load carrying capacity and slow motion and to reduce the size of the system.

[0031] A cluster of rhombus structure: Refer to FIGS. 4 and 5, a cluster of rhombus structure consist of three rhombuses, including a large rhombus and two small rhombuses. The rhombus structure are made up of four short edge (11) and four long edge (12), the edges are joined by hinge joints (15) and (16) at the vertices of the rhombuses. These hinges are similar to those used in cluster of rotated joints, they are used bushings or needle roller bearings for compact size. The hinge joint (16) is also used to connect to cluster of upper rotated joints (5) and cluster of lower rotated joints (9), the axis of these hinge joints being the axis of the x-axis rotated joint (19) and (20). At the long edge of the rhombus (12), there are four pivots (14) and two pivots (13) which contact with right guiding groove (26) and (27), the left guiding groove (28) and (29) in FIG. 6 and FIG. 7. The cylinder pin (13) engages the hinge joint of the rhombus and slides in the guiding groove (27), (29). The structure of rhombus and two guiding plate is assembled such as FIG. 5.

[0032] Guiding Structure: Refer to FIGS. 6 and 7, which consists of a guiding plate (24) and a guiding plate (25). On the right guide plate (24) there is a rightward curved groove (26) comprising two symmetrical grooves and a straight guiding groove (27), a flange (30) on the right guiding plate (24) for connection to the beam (35) on the spring fixtures . Similar to the right plate, the left guiding plate (25) also has a left curved groove (28), a straight groove (29) and a flange (31). The right curved guiding groove (26) and the left curved guiding groove (28) are symmetrical. Two plates are connected to the rhombus structure by contact between the guide grooves (26), (27), (28), (29) with the pivots (13) and (14) FIG. 5. The guiding plates are connected to the springs by contact between the flange (30) and the beam (35) can be seen in FIG. 11, FIG. 12, FIG. 13. The center line of grooves (27), (29) is the straight line, the center line of the groove (26), (28) has a trajectory that is calculated from the following equation:

F.sub.elasticd.sub.spring=F.sub.loadd.sub.z

[0033] F.sub.elastic: the elastic force of the springs.

[0034] F.sub.load: the force of the load impact on the support mechanism.

[0035] d.sub.spring: differential displacement of springs (total displacement due to rhombus structure and adjustment of guiding groove).

[0036] d.sub.z: The differential displacement of the moving frame.

[0037] d.sub.spring is calculated by the following formula:

d.sub.spring=d.sub.thombus+d.sub.groove

[0038] d.sub.thombus differential displacement of pivots (14), depends on the texture, length of the edges of the rhombus.

[0039] d.sub.groove differential displacement of trajectory of groove (26), (28).

[0040] F.sub.load is gravity value of the load, for d.sub.z is the displacement of moving frame of robot, d.sub.thombus will be a function of d.sub.z when we give the length of the edge, and the positon of pivot (14), and a condition X.sub.spring(0)=z(0)=0 we can calculate the trajectory of grooves d.sub.groove (26), (28).

[0041] Spring fixture Assembly: Refer to FIG. 11, FIG. 12 and FIG. 13, Spring fixtures include two components in the left FIG. 11 and in the right FIG. 12. Spring fixtures are composed of mounting plates (33), on which the springs (10) are positioned by shoulders (36). the Threaded rods (32) link the mounting plates to the box beams (35), the threaded rods being held onto the box beams (35) by the bolts (34). The spring fixtures consists of two left and right portions, which are interlocked, where the rhombus performs compression movement, the guiding plates (24), (25) tend to move apart, then the springs are compressed to create balance with the compression force. This spring fixture design can be seen in FIG. 13. The left guiding plate (25) through the threaded rods (32) is connected to the right end of the springs (10), similar to the right guiding plate (24) through the threaded rods (32)) is connected to the left end of the springs (10), then the two guiding plates (24), (25) being pushed away will cause the springs (10) to compress.

[0042] Springs system: The springs system consists of 16 springs (10) compressed parallel to each other, the springs are fixed to the shoulders (36), with 8 springs arranged on each side.

[0043] With the above components, when the moving frame moves down, the springs are compressed and the length of the structure decreases. Then the rhombus structure will be flattened as shown in FIG. 14. The movement of the rhombus is passed to the guiding plate (24), (25) through the pivots (14).sub.1,2,3,4. Pivots (13) have the role of keeping the guiding groove moving without rotating during movement. When the rhombus structure is compressed, the four pivots (14).sub.1,2,3,4 have the motion according to arrows in FIG. 14. Analyze each movement of the pivots: the pair of pivots (14).sub.1,4 will move away from the pair of pivots (14).sub.2,3, this movement will cause the two guiding plates (24), (25) to move apart, the pivot (14).sub.1 and the pivot (14).sub.4 as well as the pivot (14).sub.2 and pivot (14).sub.3 will move closer together. When the rhombus is compressed, the pivots (14) touch the guiding plates and move them apart. On guiding plates with guiding grooves, these grooves adjust the displacement of the locating pivots on the rhombus to the displacement of the spring such that the rhombus's thrust force is constant, this condition is ensured by the formula below. The two guiding plate (24), (25) are fixed to the box beams (35), the left guiding plate is connected through the threaded rod with the right mounting plate and the right guiding plate is connected to the left mounting plate. Due to this structure such that the movement of the two guiding plate away will compress the springs again as can be seen in FIG. 15.

[0044] When the moving frame moves upwards, the process is completely reversed, the rhombus structure is stretched, the guiding grooves (24), (25) move closer together, the spring is stretched. FIG. 14 depicts the state of the spring-support mechanism for stretching and compression.

[0045] Reference FIGS. 16 and 17, when the spring-support mechanism transpose a difference d.sub.z, so two pivots (13) transpose a difference d.sub.thoi, then two pivots (13) slide on the grooves (26)(28) and the guiding plate displace the spring a difference d.sub.lx. When a compression force F.sub.load is applied to the support mechanism, F.sub.tx impact on the flange of the guiding plate to balance with the F.sub.load FIG. 16. Consequently, the spring generate a elastic force F.sub.dh to balance with the F.sub.tx FIG. 17.

[0046] Applying principle of virtual work to this structure, we have following formulation:

F.sub.elasticd.sub.spring=F.sub.loadd.sub.z

[0047] F.sub.elastic: the elastic force of the springs.

[0048] F.sub.load: the force of the load impact on the support mechanism.

[0049] d.sub.spring: differential displacement of springs (total displacement due to rhombus structure and adjustment of guiding groove).

[0050] d.sub.z: The differential displacement of the moving frame.

[0051] d.sub.spring is calculated by the following formula:

d.sub.spring=d.sub.thombus+d.sub.groove

[0052] d.sub.thombus differential displacement of pivots (14), depends on the texture, length of the edges of the rhombus.

[0053] d.sub.groove differential displacement of trajectory of groove (26), (28).

[0054] F.sub.load is gravity value of the load, for d.sub.z is the displacement of moving frame of robot, d.sub.thombus will be a function of d.sub.z when we give the length of the edge, and the position of pivot (14), and a condition x.sub.spring(0)=z(0)=0 we can calculate the trajectory of grooves d.sub.groove (26), (28).