JP5394358B2 - Parallel link robot with posture change mechanism with 3 degrees of freedom - Google Patents

Description

  The present invention relates to a parallel link robot.

  A parallel link in which a plurality of motors are attached to a fixed member as a base member, and a link connected to the output portion of the actuator is driven to control the position and posture of a movable member attached to the tip of each link. Various types of robots have been developed. Since the parallel link robot has a structure in which the base member and the movable member are connected by a plurality of links, the parallel link robot has characteristics such as high accuracy, high rigidity, and high speed. Due to these characteristics, parallel link robots are widely known as high-speed handling and assembly robots.

Patent Document 1 discloses a parallel link robot shown in FIG. The parallel link robot shown in FIG. 11 adopts a structure called a delta type, and includes one base member 200 and one movable member 208.
The base member 200 has three rotary actuators 213, each rotary actuator having one fixed part that forms an integral element with the base member 200, and its axis 202 is in the same plane. Each drive link 204 is attached to each rotating shaft 202 at its one end 215 in the form of a rigid assembly. The other end 216 of each drive link 204 forms an integral element with the two passive links 205a, 205b by two cardan-type double joints. In addition, each of the two groups of the passive links 205a and 205b is connected to the movable member 208 by two cardan-type double joint portions 207a and 207b. Can be controlled. A working member such as the hand 209 can be disposed on the movable member 208.

  The movable member 208 has a posture changing axis called a fourth axis for changing the posture of a working member such as a hand, and the fourth axis is an axis perpendicular to the surface of the movable member 208. A work member such as the hand 209 is rotationally driven by a rotation motor 211 disposed on the base member 200 via a drive shaft 214. The three actuators 213 and the rotary motor 211 are controlled by a control device 212.

Japanese Examined Patent Publication No. 4-45310

  The parallel link robot disclosed in Patent Document 1 described above includes a posture change axis called a fourth axis in order to change the posture of a working member such as the hand 209 disposed on the movable member 208. However, it was not possible to perform the work of attaching the component to the inclined surface with only the fourth axis.

  Accordingly, an object of the present invention is to provide a parallel link robot in which the degree of freedom of the posture changing axis is increased in view of the above circumstances.

In the invention according to claim 1 of the present application, three sets of link mechanisms including a drive link and a passive link are jointly connected in parallel between the base member and the movable member, and the attitude of the end effector is controlled by the movable member. In the parallel link robot provided with the posture changing mechanism unit having three degrees of freedom, the movable member is connected to the movable member and the three passive links. A first rotating member connected to be rotatable about four axes, a second rotating member connected to the first rotating member to be rotatable about a fifth axis orthogonal to the fourth axis, and the second The rotating member includes a third rotating member connected to be rotatable about a sixth axis orthogonal to the fifth axis , and the movable member is provided with three input shafts, and the three input shafts are Movable member and three The axes that are perpendicular to and parallel to the plane that includes the rotation axis of each joint that connects the passive links, and the three motors that drive the posture changing mechanism are disposed on the base member, Each having three independent drive shafts for transmitting each drive force from the motor, the drive shafts being connected so as to be rotatable about the respective axes of the three input shafts; Each driving force is transmitted around the fourth axis, around the fifth axis, around the sixth axis via the gears arranged in the posture changing mechanism, and the first rotating member, the second rotating member, A parallel link robot that drives a third rotating member.

  According to the present invention, it is possible to provide a parallel link robot in which the degree of freedom of the posture change axis is increased.

It is a schematic block diagram of the parallel link robot provided with the triaxial attitude | position change mechanism part. It is a schematic longitudinal cross-sectional view of a parallel link robot. It is an expansion perspective view which shows the movable member and attitude | position change mechanism part of a parallel link robot. It is a side external view of a posture change mechanism part. It is an external view of the attitude | position change mechanism part which can avoid that the singular point which is embodiment of this invention generate | occur | produces. It is a schematic block diagram of the parallel link robot provided with the attitude | position change mechanism part which inclined the flange surface which is embodiment of this invention. It is a figure explaining the state which attached the hand to the attitude | position change mechanism part which inclined the flange surface. It is a figure explaining the schematic structure inside the attitude | position change mechanism part which inclined the flange surface. It is a principal part expanded sectional view of an attitude | position change mechanism part drive mechanism, (a) Sectional drawing which shows a holder assembly, (b) Other longitudinal sectional views which show a holder assembly. It is a principal part enlarged view of an attitude | position change mechanism part drive mechanism. It is a schematic block diagram of the parallel link robot which is a prior art.

Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 is a schematic configuration diagram of a parallel link robot including a three-axis posture changing mechanism unit.
The parallel link robot PR includes a base member 12 and a movable member 100, and a parallel member type movable member drive mechanism 16 formed by connecting the base member 12 and the movable member 100 by three sets of link structures arranged in parallel. The movable member 100 is configured to perform only a three-axis translational movement with respect to the base member 12 (in other words, provided with a parallel mechanism having three degrees of freedom).

The parallel link robot PR according to an embodiment of the present invention further includes a posture change mechanism unit 102 capable of rotating the movable member 100 in three axes and a posture change mechanism unit 102 around the three axes with respect to the movable member 100. An attitude change mechanism drive mechanism 20 for rotation is provided.
The base member 12 is composed of a plate-like structure that is fixedly provided on the upper end of an arc wall-like stand 22 that is installed on the installation surface of the parallel link robot PR so as to project horizontally to the side. The base member 12 is a stationary member that carries a component group of a movable member drive mechanism 16 and a posture change mechanism section drive mechanism 20 described later. A cover 24 that covers a driving motor, a power transmission mechanism, and the like is fixed to the base member 12 so as to be detachably fixed to the upper side of the base member 12.

  The movable member drive mechanism 16 includes three sets of link structures 26 arranged in parallel to each other, and three servo motors 28 (only one is shown in FIG. 2) for individually driving the link structures 26. Yes. Each set of link structures 26 is driven via a rotary link and a drive link 30 that is articulated to the output of the base member 12 and the corresponding servo motor 28 via a plurality of rotary pairs (hinge joints) and auxiliary links. A pair of parallel passive links 32 articulated at the ends of the links 30. The parallel passive link 32 is articulated at its end to the movable member 100 via a rotating pair.

  The drive link 30 is driven by the servo motor 28 and swings in various ways along a virtual plane perpendicular to the base member 12. The parallel passive link 32 is displaced on the same virtual plane as the drive link 30 swings. At this time, since the parallel passive links 32 of the one set of link structures 26 are connected to the parallel passive links 32 of the other two sets of link structures 26 via the movable member 100, the parallel sets of the three sets of link structures 26 are parallel. The passive link 32 swings variously in a passive manner according to the swing mode of the three drive links 30.

  In the three sets of link structures 26, each drive link 30 is connected to the base member 12 at three fixed positions separated from each other by a central angle of 120 degrees on the base member 12, and each passive link 32 is connected to the base member 12. The movable member 100 is connected to the movable member 100 at three fixed positions separated from each other by a central angle of 120 degrees. As a result, the movable member 100 performs only a three-axis translational movement with respect to the base member 12 by the operation of the movable member driving mechanism 16.

  As shown in FIG. 2, the base member 12 includes three servo motors 28 for driving (only one is shown in FIG. 2) included in the three sets of movable member driving mechanisms 16 and driving of the attitude changing mechanism unit. A mechanism 20 (only one is shown in FIG. 2) is arranged. The base member 12 is formed with a hollow cylindrical seat 56 projecting toward the cover 24, and the outer holder 44 of the holder assembly 50 is connected to the inner ring of the rotary bearing device 58 at one end in the axial direction of the outer peripheral surface of the outer holder 44. While the outer ring of the rotary bearing device 58 is fixed to the inner peripheral surface of the hollow cylindrical mounting member 60, one end in the axial direction of the seat portion 56 of the mounting member 60 (upper end in the drawing) (See FIG. 10).

  FIG. 4 is a side external view of the posture changing mechanism unit of the posture changing mechanism unit 102. The posture changing mechanism unit 102 is connected to the movable member 100, and the posture changing mechanism unit 102 is centered on a fourth axis 106a perpendicular to a plane including the rotation axis of the joint unit 36 connecting the three parallel passive links. A first rotating member 106 that can be rotated around it as a shaft, a second rotating member 108 that can be rotated around the fifth axis 108a as a central axis, and a shaft that can rotate around the sixth axis 110a as a central axis A third rotating member 110 is provided.

  FIG. 3 is an enlarged perspective view showing the movable member 100 and the posture changing mechanism unit 102 of the parallel link robot PR in one embodiment of the present invention. The movable member 100 is formed of a cylindrical member having a hollow portion (not shown), and connection portions 104 for connecting the parallel passive links 32 of the three sets of link structures 26 of the movable member drive mechanism 16 are formed at three locations on the outer periphery thereof. The A rotary bearing device and a power transmission mechanism are accommodated in the hollow portion of the movable member 100 (see FIG. 8), and the posture changing mechanism portion 102 is rotatably supported in the view of the movable member 100.

  The posture changing mechanism unit 102 is connected to the first rotating member 106 connected to the movable member 100 so as to be rotatable about the fourth axis 106a, and to be rotatable about the fifth axis 108a orthogonal to the fourth axis 106a. And a third rotating member 110 connected to the second rotating member 108 so as to be rotatable about a sixth axis 110a orthogonal to the fifth axis 108a. A first flange surface 112 for attaching a tool (not shown) to the third rotating member 110 is provided. The posture changing mechanism unit 102 connects the first rotating member to the movable member 100 so that the posture changing mechanism unit 102 can rotate around a fourth axis perpendicular to the plane including the rotation axis of the joint 36 connecting the parallel passive link 32. Has been.

  Of the three attitude change mechanism section drive mechanisms 20, the first attitude change mechanism section drive mechanism 20 has a first universal joint 80-1 and a power train element such as a gear train (see FIG. 8). The 1st transmission member 54-1 connected to the 1 rotation member 106 is provided. The first transmission member 54-1 transmits the rotation of the first outer holder 44, which is rotationally driven by the first servo motor 52 (see FIG. 10), to the first rotation member 106. Is rotated around the fourth axis 106a.

Of the three posture change mechanism unit drive mechanisms 20, of the second posture change unit drive mechanisms 20, the second posture change unit drive mechanism 20 includes a second universal joint 80-2 and a gear train (FIG. 8). A second transmission member 54-2 connected to the second rotation member 108 via a power transmission element (see FIG. 1).
The second transmission member 54-2 transmits the rotation of the second outer holder 44 that is rotationally driven by the second servo motor 52 (see FIG. 10) to the second rotation member 108, and the second rotation member 108. Is rotated around the fifth axis 108a.

Of the three attitude change mechanism drive mechanisms 20, of the third attitude change mechanism drive mechanism 20, the third universal joint 80-3 and the gear train and the like (see FIG. 8) are used for power transmission. A third transmission member 54-3 connected to the three-rotation member 110 is provided. The third transmission member 54-3 transmits the rotation of the third outer holder 44, which is rotationally driven by the third servo motor 52, to the third rotation member 110, and transmits the third rotation member 110 to the sixth axis 110a. Rotate around. The third rotating member 110 has a flange surface at the tip for attaching an end effector.
The parallel link robot PR provided with the posture changing mechanism unit 102 capable of rotating around three axes is subjected to three-axis translation and three-axis rotation by an end effector (not shown) mounted on the flange surface of the posture changing mechanism unit 102. It can be performed in combination with exercise.

  In the parallel link robot PR having the posture changing mechanism unit 102 shown in FIGS. 3 and 4, a plane parallel to the plane including the rotation axis of each joint unit 36 connecting the parallel passive links 32 (the parallel link robot PR is installed on the floor). When placed, the horizontal plane) is a frequently used area. When the first flange surface 112 becomes horizontal, the fourth axis line 106a and the sixth axis line 110a have a parallel arrangement relationship, which is a singular point. The singular point is that when the position of the sixth axis 110a is specified, the fourth axis 106a becomes an angular position somewhere around the sixth axis 110a, so that the solution is uniquely determined when calculating the position. It is said that it cannot be decided.

  Therefore, as shown in FIG. 5, the second flange surface is provided on the third rotating member 110 so that the sixth axis 110 a and the seventh axis 112 a perpendicular to the flange surface have a predetermined angle α so that no singular point is generated. Is provided. By adopting such a structure, even when the second flange surface 114 is horizontal, the fourth axis 106a and the sixth axis 110a are not parallel, and the horizontal plane with high use frequency becomes a singular point. It can be avoided. If the predetermined angle α is 30 degrees to 60 degrees, it is suitable for attaching the hand 122 and causing the hand 122 to perform work.

  Due to the simple structure in which the second flange surface 114 is provided on the third rotating member 110 so that the axis perpendicular to the sixth axis 110a and the second flange surface 114 has a predetermined angle, the horizontal plane that is frequently used is a singular point. Can be avoided. Thereby, an inexpensive and compact posture changing mechanism can be realized, the operation of each axis can be easily understood, and the usability of the parallel link robot PR is greatly improved. In addition, it is not necessary to provide an angle to the attachment portion of the hand or tool, making it easier to produce the hand or tool and making them inexpensively.

  FIG. 6 is a schematic configuration diagram of a parallel link robot PR provided with a posture changing mechanism unit in which the flange surface is inclined according to the embodiment of the present invention. A hand (see FIG. 7) for performing work such as gripping and moving the workpiece is attached to the flange surface of the posture changing mechanism unit 102 having the inclined second flange surface.

  When gripping a workpiece placed in a horizontal plane, the hand 122 (see FIG. 7) needs to be directed downward. The hand mounting portion 120 of the hand 122 is attached to the second flange surface 114. As described above, in the parallel link robot PR using the posture changing mechanism unit 102 in which the flange surface is inclined, even when the second flange surface 114 is horizontal and the hand 122 is directed directly downward, the fourth axis 106a and the sixth axis It is not parallel to the axis 110a, and it can be avoided that the horizontal plane becomes a singular point.

  FIG. 8 is a diagram illustrating a schematic structure inside the posture changing mechanism section in which the flange surface is inclined. The driving force for rotationally driving the posture change mechanism unit 102 is transmitted by the drive shafts 54-1, 54-2, 54-3 of the three independent posture change mechanism unit drive mechanisms 20 (see FIG. 3). This driving force is applied to an input shaft connected via a bearing so as to be rotatable about an axis perpendicular to and parallel to each other with respect to a plane including the axis of each joint portion 36 connecting the parallel passive link 32 on the movable member 100. Are transmitted through universal joints 80-1, 80-2, 80-3 (see FIG. 3).

  Gears 4-1, 5-1 and 6-1 (gears 5-1 and 6-1 are not shown) are fixed to the tips of the input shafts. The first rotating member 106 is rotatably connected to the movable member 100 via a bearing. A gear 4-2 is fixed to the first rotating member 106, the gear 4-1 and the gear 4-2 are meshed, and the rotational driving force transmitted to the gear 4-1 is transmitted to the gear 4-2. One rotation member 106 rotates.

  Gears 5-2 and 5-3 are rotatably connected to the first rotating member 106 through bearings. The gear 5-2 and the gear 5-3 are fixed so that a driving force can be transmitted. The gear 5-4 is fixed to the second rotating member 108, and the second rotating member 108 is rotatably connected to the first rotating member via a bearing. The driving force transmitted to the gear 5-1 is transmitted to the gear 5-2, the gear 5-3, and the gear 5-4, and the second rotating member 108 rotates. In addition, the third rotating member 110 has a driving force transmitted to the gear 6-1 (not shown) as a gear 6-2, a gear 6-3, a gear 6-4, a gear 6-5, and a gear 6-6. It is rotated by being transmitted. Note that the gears and the gears and the rotating member may be fixed as long as power can be transmitted, and the coupling means such as bolt coupling, key coupling, and adhesive coupling may be appropriately selected and employed.

  FIG. 9 is an enlarged cross-sectional view of the main part of the posture changing mechanism drive mechanism, (a) a cross-sectional view showing the holder assembly, and (b) another vertical cross-sectional view showing the holder assembly. The posture change mechanism unit drive mechanism 20 is a drive mechanism that is attached to the posture change mechanism unit 102 and controls the posture of a hand (see FIG. 7) and a tool installed on the movable member 100. The parallel link robot PR according to the embodiment of the present invention includes three posture change mechanism unit driving mechanisms 20 that can operate independently of each other. The base member 12 is formed with three seats 56 similar to the seats 56 shown in FIG. 2 at appropriate positions surrounding substantially the center of the three sets of link structures 26, and the outer sides of the individual holder assemblies 50. A holder 44 is attached to the corresponding seat 56. Accordingly, the three posture changing mechanism unit driving mechanisms 20 are configured by arranging the first axes 44a of the respective holder assemblies 50 in parallel with each other.

  The posture changing mechanism section drive mechanism 20 includes a holder assembly 50 configured by combining three hollow cylindrical holders 44, 46, and 48 in a mutually rotatable and triple nested manner, and the holder assembly 50. Servo motor 52 (see FIG. 10) that rotationally drives the outer holder 44 and a rod-like drive shaft 54 that is received by the inner holder 48 of the holder assembly 50 so as to be linearly movable (ie, linearly movable).

  As shown in FIG. 9A, the intermediate holder 46 of the holder assembly 50 has an outer peripheral surface having a smaller diameter than the inner peripheral surface of the outer holder 44, and the outer peripheral surface has a predetermined 180 ° opposite to each other. A pair of support shafts 62 projecting radially outward are formed at the locations. The support shafts 62 are arranged so that the respective geometric center lines coincide with each other and are orthogonal to the geometric center line of the intermediate holder 46. On the other hand, the outer holder 44 is formed with a pair of shaft holes 64 penetrating in the radial direction at predetermined positions on the inner peripheral surface opposite to each other by 180 degrees. The shaft holes 64 are arranged such that the respective geometric center axes coincide with each other and are orthogonal to the geometric center axis of the outer holder 44.

  The intermediate holder 46 is attached to the outer holder 44 via a pair of rotary bearing devices 66 installed in the shaft holes 64 by inserting individual support shafts 62 into corresponding shaft holes 64 of the outer holder 44. Specifically, the outer ring of each rotary bearing device 66 is fixed to the inner peripheral surface of each shaft hole 64 of the outer holder 44. In this state, the intermediate holder 46 is installed in the outer holder 44 so as to be rotatable about a second axis 46a orthogonal to both its own geometrical center axis and the first axis 44a.

  As shown in FIG. 9B, the inner holder 48 of the holder assembly 50 has an outer peripheral surface having a smaller diameter than the inner peripheral surface of the intermediate holder 46, and the outer peripheral surface has a predetermined 180 ° opposite to each other. A support shaft 68 protruding outward in the radial direction is formed at the location. The support shafts 68 are arranged such that the respective geometric center lines coincide with each other and are orthogonal to the geometric center axis of the inner holder 48. On the other hand, the intermediate holder 46 is formed with a pair of shaft holes 70 penetrating in the radial direction at predetermined positions 180 degrees opposite to each other at a position shifted by 90 degrees from the pair of support shafts 62. The shaft holes 70 are arranged such that the respective geometric center axes coincide with each other and are orthogonal to the geometric center axis of the intermediate holder 46.

  The inner holder 48 and the individual support shafts 68 are inserted into corresponding shaft holes 70 of the intermediate holder 46 and attached to the intermediate holder 46 via a pair of rotary bearing devices 72 installed in the shaft holes 70. Specifically, the inner ring of each rotary bearing device 72 is fixed to the outer peripheral surface of each spindle 68 of the inner holder 48, while the outer ring of each rotary bearing device 72 is attached to the inner peripheral surface of each shaft hole 70 of the intermediate holder 46. Fixed. In this state, the inner holder 48 is installed in the intermediate holder 46 so as to be rotatable about a third axis 48a orthogonal to both its own geometrical center line and the second axis 46a.

  A gear 74 as a power transmission element is fixed to the outer holder 44 at the other axial end of the outer peripheral surface (upper end in the figure), and an output shaft 76 of the servo motor 52 is connected to the gear 74 (see FIG. 10). ). The servo motor 52 rotationally drives the outer holder 44 around the first axis 44 a via the gear 74. In place of the gear 74, a belt and a pulley can be used as a power transmission element.

  The drive shaft 54 is an integral rod-like element having an outer peripheral surface having a smaller diameter than the inner peripheral surface of the inner holder 48 of the holder assembly 50, and a linear motion bearing member 78 installed inside the inner holder 48 is provided. To the inner holder 48. In this state, the drive shaft 54 moves linearly in a rotationally restrained state over the entire length along a linear motion axis 54a that is parallel to both itself and the geometric center axis of the inner holder 48 and perpendicular to the third axis 48a. Possible to be received in the inner holder 48. In the illustrated embodiment, the linear axis 54 a coincides with the geometric center axis of the drive shaft 54 and the inner holder 48.

  The linear motion bearing member 78 that guides the drive shaft 54 in a rotationally restricted state is required to transmit the output of the servo motor 52 to the drive shaft 54 with as little loss as possible from the viewpoint of improving the accuracy of posture control of the hand and the tool. . As such a linear motion bearing member 78, a spline shaft of a ball spline device can be suitably used. In this case, the drive shaft 54 has a spline shaft structure of a ball spline device. Since the details of the ball spline device are known, the description is omitted.

  As shown in FIG. 10, the holder assembly 50 is disposed between the base member 12 and the output shaft 76 of the servo motor 52 and the drive shaft 54 in the direction of the geometric center axis (linear motion shaft 54 a) of the drive shaft 54. It functions as a universal joint with a special structure that can be moved relative to each other. That is, the outer holder 44 is the driving side component of the universal joint, and the inner holder 48 is the driven side component of the universal joint. Therefore, the drive shaft 54 is synchronized with the rotation of the outer holder 44 driven by the servo motor 52 in any positional relationship in which the linear movement shaft 54 a is parallel and oblique to the first axis 44 a of the outer holder 44. Thus, it rotates integrally with the inner holder 48 around the linear motion shaft 54a.

  In the holder assembly 50, the allowable inclination angle of the drive shaft 54 with respect to the outer holder 44 (that is, the linear movement shaft 54a with respect to the first axis 44a) is determined by relative positions and dimensions of the outer holder 44, the intermediate holder 46, and the inner holder 48. It depends on the relationship. In general work (handling work) by the parallel link robot PR, it is desirable that the drive shaft 54 can be tilted within a range of about 0 to 40 degrees. The holder assembly 50 configured by combining the three hollow cylindrical holders 44, 46, and 48 in a triple nested manner has the intermediate holder 46 and the inner holder 48 attached to the outer holder 44 as shown in the figure. Therefore, the overall dimensions of the holder assembly 50 can be relatively easily reduced without impairing the required universal joint capability.

  In particular, in the parallel link robot PR, the drive shaft 54 smoothly follows the three-axis translational movement of the movable member 100 and the posture changing mechanism unit 102 by the movable member drive mechanism 16 of the parallel mechanism type, and the base member 12 and the servo motor. The holder assembly, which is a universal joint between the output shaft 76 and the drive shaft 54, can be passively moved in the direction of the linear motion shaft 54a. As a result, when the movable member 100 and the posture changing mechanism unit 102 are in an arbitrary (that is, commanded) space position within the operation region, the torque of the servo motor 52 is reliably transmitted to the posture changing mechanism unit 102. .

  Here, as described above, the movable member driving mechanism 16 drives the movable member 100 so as to perform only the three-axis translational movement with respect to the base member 12, so that the posture is maintained while the movable member driving mechanism 16 operates. The input shaft of the change mechanism unit 102 is always arranged in parallel to the first axis 44 a of the holder assembly 50. As a result, regardless of the inclination angle of the drive shaft 54 with respect to the base member 12, the angular velocity of the outer holder 44 and the respective velocities of the input shaft of the attitude changing mechanism unit 102 coincide with each other.

  In the above configuration, the drive shaft 54 follows the three-axis translational movement of the movable member 100 and the posture changing mechanism unit 102, and has various angles above the outer holder 44 of the holder assembly 50 carried by the base member 12. It extends over various lengths. Therefore, the servo motor 52 of the posture changing mechanism section drive mechanism 20 is supported by the base member 12 at a position adjacent to the outer holder 44 so as not to protrude in a direction away from the movable member 100 than the outer holder 44. This is advantageous from the viewpoint of avoiding mutual interference between the servo motor 52 and the drive shaft 54 (see FIG. 10).

PR parallel link robot 12 basic member 16 movable member drive mechanism 20 posture change mechanism unit drive mechanism 26 link structure 28 servo motor 30 drive link 32 passive link 52 servo motor 54 drive shaft 100 movable member 102 posture change mechanism unit 106 first rotating member 106a Fourth axis 108 Second rotating member 108a Fifth axis 110 Third rotating member 110a Sixth axis 112 First flange surface 114 Second flange surface

Claims (1)

A posture changing mechanism having three degrees of freedom for jointly connecting three sets of link mechanisms including a drive link and a passive link between the base member and the movable member to control the posture of the end effector to the movable member. In the parallel link robot with
A first rotation member connected to the movable member so as to be rotatable about a fourth axis perpendicular to a plane including a rotation axis of each joint portion connecting the movable member and the three passive links; A second rotating member connected to one rotating member so as to be rotatable about a fifth axis orthogonal to the fourth axis, and a second rotating member rotatable about a sixth axis orthogonal to the fifth axis A third rotating member connected to the
The movable member is provided with three input shafts,
The three input shafts are axes perpendicular to and parallel to a plane including a rotation axis of each joint portion connecting the movable member and the three passive links.
Three motors for driving the posture changing mechanism are disposed on the foundation member,
Having three independent drive shafts for transmitting each drive force from the three motors,
The drive shafts are coupled so as to be able to rotate around the respective axes of the three input shafts, and each drive force from the three motors is transmitted through the gears disposed in the posture changing mechanism section. A parallel link robot that drives the first rotating member, the second rotating member, and the third rotating member around four axes, around the fifth axis, and around the sixth axis.

Images