JP5104456B2 - Frogleg arm robot - Google Patents

Description

  The present invention relates to a frog-leg-arm robot that transfers an object to be conveyed while being placed on a hand unit.

2. Description of the Related Art Conventionally, an arm robot that transfers a predetermined transport object while being placed on a hand unit has been used. Among such arm robots, there is a so-called frog-leg arm robot in which the hand portion is supported by two arm portions that move in synchronization (see, for example, Patent Document 1).
Japanese Patent Laid-Open No. 9-126871

By the way, the frog-leg-arm robot is provided with gears at the tips of the two arm parts connected to the hand part in order to make the posture of the hand part constant during expansion and contraction, and the gears mesh with each other, The structure which synchronizes two arm parts is employ | adopted.
However, in a configuration in which synchronization is performed using the gears, if the load increases according to the weight of the object to be transported, it is necessary to use a large gear according to the load, which increases the weight of the frog leg arm robot. End up. Moreover, since the play which exists between meshing of a gear and a gear inhibits the smoothness of operation | movement of an arm part, the positioning accuracy of a hand part also falls. Further, the positional accuracy of the assembly parts of the gear is also required, and the assembly becomes complicated. Furthermore, in a clean room that handles precision parts and the like, there is a problem that a cover ring that covers the gears is required to prevent dust generation from the gears.

  The present invention has been made in view of the above problems, and the two arm portions are synchronized without providing a mechanical structure such as a gear at the tip of the two arm portions, and the posture of the hand portion is constant. An object of the present invention is to provide a frog-leg-arm robot that can be used.

In order to solve the above-described problems, the present invention provides a first drive arm unit and a second drive arm unit that are provided in a pair and swing in opposite directions along a reference plane by driving a first motor. One end is rotatably connected to the swing end of the first drive arm, and one end is connected to the swing end of the first drive arm and the second drive arm that can swing along the reference plane. The second driven arm portion that is rotatably connected and swingable along the reference plane, the other end portion of the first driven arm portion, and the other end portion of the second driven arm portion are rotatably connected. A frog-leg-arm robot including a first handed arm and a first driven arm connected to the first driven arm and the first driven arm. Supply driving force to one of the second connecting parts Any one of the second motor, the third connecting portion to which the second driving arm portion and the second driven arm portion are connected, and the fourth connecting portion to which the second driven arm portion and the hand portion are connected. A configuration is adopted in which a third motor that supplies a driving force and a control device that controls the driving of the second motor and the third motor according to the driving of the first motor are employed.
By adopting such a configuration, in the present invention, the arm portions can be electrically synchronized by driving the second motor and the third motor in accordance with the driving of the first motor.

The present invention further includes a first detection device that detects a rotation angle of the second motor and a second detection device that detects a rotation angle of the third motor, and the control device includes the first detection device. Based on this detection result and the detection result of the second detection device, a configuration is adopted in which the driving of the second motor and the third motor is synchronized.
By adopting such a configuration, in the present invention, the second motor and the third motor can be driven while detecting the respective rotation angles of the second motor and the third motor. It can be taken with high accuracy.

In the present invention, the control device may be configured such that, based on a detection result of the first detection device and a detection result of the second detection device, a rotation angle of the first driven arm portion with respect to the hand portion, and the hand portion. A configuration is adopted in which the driving of the second motor and the third motor is synchronized so that the rotation angle of the second driven arm portion with respect to the rotation is symmetrical with respect to a predetermined reference line.
By adopting such a configuration, in the present invention, it is possible to accurately move the hand unit along the reference line while keeping the posture of the hand unit constant.

In the present invention, the second motor is provided in one of the first drive arm portion and the first driven arm portion, and the third motor is provided with the second drive arm portion and the first drive arm portion. The structure of being provided inside either one of the two driven arm portions is adopted.
By adopting such a configuration, in the present invention, by providing a motor inside the arm portion, it is possible to prevent dust generation more reliably and to make the outer shape slim.

According to the present invention, the first drive arm unit and the second drive arm unit that are provided as a pair and swing in opposite directions along the reference plane by driving the first motor, and the first drive arm unit. One end is rotatably connected to the swing end of the first driven arm and the second drive arm that is swingable along the reference plane. A second driven arm portion swingable along the reference plane; and a hand portion to which the other end portion of the first driven arm portion and the other end portion of the second driven arm portion are rotatably connected. A frog-leg-arm robot, which is any one of a first connection part to which the first drive arm part and the first driven arm part are connected and a second connection part to which the first driven arm part and the hand part are connected. A second motor for supplying driving force to one of the two, A third motor for supplying a driving force to any one of a third connecting portion to which the driving arm portion and the second driven arm portion are connected and a fourth connecting portion to which the second driven arm portion and the hand portion are connected. And a control device that controls the driving of the second motor and the third motor in accordance with the driving of the first motor, thereby adopting a second motor corresponding to the driving of the first motor, and The arm unit can be electrically synchronized by driving the third motor.
Accordingly, the present invention provides a frog-leg arm robot that can synchronize the two arm portions without providing a mechanical structure such as a gear at the tips of the two arm portions and can keep the posture of the hand portion constant. Can be provided.
In other words, in the present invention, dust generation due to mechanical contact between gears is prevented, so there is no need for a cover in the hand part, and there is no need to provide a heavy gear that requires assembly accuracy. There is an effect that the weight can be reduced and the assembly can be facilitated. Furthermore, in the present invention, even if a play is generated due to the structure, the play can be corrected to the minimum by driving the second motor and the third motor, so that the positioning accuracy of the hand part can be improved and the operation can be smoothed. is there.

  Next, embodiments of the present invention will be described with reference to the drawings. In the following drawings, the scale of each member is appropriately changed in order to make each member a recognizable size.

FIG. 1 is a plan view showing a schematic configuration of a frog-leg-arm robot R in an embodiment of the present invention. FIG. 2 is a side view showing a schematic configuration of the frog-leg-arm robot R in the embodiment of the present invention. FIG. 3 is a block diagram showing a functional configuration of the frog-leg-arm robot R in the embodiment of the present invention.
As shown in FIG. 1, the frog-leg arm robot R of this embodiment includes a main body 1, an arm 2, a hand 3, and a controller (control device) 4.

  As shown in FIG. 2, the main body 1 is rotatably installed on a base B such as a cage of a stacker crane. The main body portion 1 is provided with a driving device 5 for moving the hand portion 3 back and forth along a horizontal plane (reference plane) by swinging the arm portion 2. As shown in FIG. 1, the driving device 5 includes a first main motor (first motor) 51 and a second main motor (first motor) 52. The first main motor 51 is a servo motor including an encoder that detects the rotation angle of the output shaft. One second main motor 52 is also a servo motor having the same configuration as the first main motor 51.

  The arm part 2 is composed of a pair of arm parts 21 and 22 arranged symmetrically in the width direction of the main body part 1. In the following description, the arm portion 21 is referred to as a first arm portion 21, and the arm portion 22 is referred to as a second arm portion 22.

The first arm unit 21 includes a first drive arm unit 23 and a first driven arm unit 24. One end of the first drive arm 23 is fixed to the output shaft of the first main motor 51 provided in the main body 1. When the first main motor 51 is driven to rotate, the first drive arm portion 23 swings around an axis extending along the horizontal plane and the other end portion (swinging end portion) passing through the one end portion and perpendicular to the horizontal plane. Is possible. A joint to which the first drive arm portion 23 and the first main motor 51 are connected is referred to as a first shoulder joint portion 6a.
One end portion of the first driven arm portion 24 is rotatably connected to the other end portion of the first drive arm portion 23, and the other end portion is along the horizontal plane around an axis extending through the one end portion and perpendicular to the horizontal plane. And can be swung. The joint to which the first drive arm portion 23 and the first driven arm portion 24 are connected is referred to as a first elbow joint portion (first connection portion) 6b.

The second arm portion 22 includes a second drive arm portion 25 and a second driven arm portion 26. One end of the second drive arm unit 25 is fixed to the output shaft of the second main motor 52 provided in the main body unit 1. When the second main motor 52 is driven to rotate, the second drive arm portion 25 swings around an axis extending along the horizontal plane and the other end portion (swing end portion) passing through the one end portion and perpendicular to the horizontal plane. Is possible. A joint to which the second drive arm portion 25 and the second main motor 52 are connected is referred to as a second shoulder joint portion 6c.
One end portion of the second driven arm portion 26 is rotatably connected to the other end portion of the second drive arm portion 25, and passes through the one end portion around an axis extending perpendicular to the horizontal plane, and the other end portion along the horizontal plane. And can be swung. A joint to which the second drive arm portion 25 and the second driven arm portion 26 are connected is referred to as a second elbow joint portion (third connection portion) 6d.

The hand unit 3 holds or supports a conveyance object (for example, a glass substrate or a cassette containing a glass substrate) and is supported on a horizontal plane by the first arm unit 21 and the second arm unit 22. Yes. More specifically, the hand portion 3 is supported by rotatably connecting the other end portion of the first driven arm portion 24 and the other end portion of the second driven arm portion 26. The other end portions of the first driven arm portion 24 and the second driven arm portion 26 are rotatable independently of the hand portion 3.
Further, a joint to which the first driven arm portion 24 and the hand portion 3 are connected is referred to as a first wrist joint portion (second connection portion) 6e. The joint to which the second driven arm portion 26 and the hand portion 3 are connected is referred to as a second wrist joint portion (fourth connection portion) 6f.

In the frog-leg-arm robot R of this embodiment, the driving of the first arm unit 21 and the second arm unit 22 is synchronized so that the posture of the hand unit 3 on the horizontal plane is constant with respect to the main body unit 1. A synchronizing means 10 is provided. The synchronization means 10 includes a first sub motor (second motor) 11 and a second sub motor (third motor) 12 whose driving is controlled by the control unit 4.
The first sub motor 11 supplies driving force to the first wrist joint portion 6e. As shown in FIG. 2, the main body of the first sub motor 11 is fixed on the hand portion 3 at the first wrist joint portion 6e, and the output shaft Is fixed to the first driven arm portion 24. Accordingly, the first sub motor 11 is configured to drive the first wrist joint portion 6e by generating a driving force that relatively rotates the hand portion 3 and the first driven arm portion 24 by being rotationally driven. ing. Further, the first sub motor 11 employs a servo motor including an encoder (first detection device) that detects the rotation angle of the output shaft.
In contrast to the first sub motor 11, the main body of the second sub motor 12 is fixed on the hand portion 3 at the second wrist joint portion 6 f, and the output shaft thereof is fixed to the second driven arm portion 26. Therefore, the second sub motor 12 is configured to drive the second wrist joint portion 6f by rotating and generating a driving force that relatively rotates the hand portion 3 and the second driven arm portion 26. ing. The second sub motor 12 employs a servo motor that includes an encoder (second detection device) that detects the rotation angle of the output shaft.

  The control unit 4 controls the entire operation of the frog-leg-arm robot R, and includes a calculation processing unit 41 and a storage unit 42 as shown in FIG. The arithmetic processing unit 41 receives a drive command from a command unit (not shown), and an electric signal for driving the first main motor 51, the second main motor 52, the first sub motor 11 and the second sub motor 12 based on the drive command. And a detection result of the rotation angle of each output shaft is input from the encoders provided in each of the first main motor 51, the second main motor 52, the first sub motor 11 and the second sub motor 12. It has become. The storage unit 42 stores various applications used in the arithmetic processing unit 41, arithmetic expressions for arm operation, and the like, and further stores detection results output from each encoder.

Next, the operation of the frog leg arm robot R of the present embodiment configured as described above (a method for controlling the frog leg arm robot R) will be described with reference to FIGS.
FIG. 4 is a diagram illustrating the operation of the hand unit 3 of the frog-leg arm robot R extending forward, and FIG. 5 is a diagram illustrating the operation of the hand unit 3 of the frog-leg arm robot R retracting backward. Show. FIG. 6 is a flowchart for explaining the control of the first sub motor 11 and the second sub motor 12.

  First, an operation in which the frog-leg arm robot R shown in FIG. 4 extends forward will be described.

A command unit (not shown) outputs an extension drive command to the control unit 4. The extension drive command includes position information for extending the hand unit 3 to the target position.
The control unit 4 that has received the extension drive command from the command unit operates the first main motor 51 and the second main motor 52 as follows.
The control unit 4 causes the arithmetic processing unit 41 based on the position information to rotate the first main motor 51 and the second main motor 52 necessary for moving the hand unit 3 to the target position (hereinafter referred to as the target angle). Is calculated based on the arithmetic expression stored in the storage unit 42. Then, the arithmetic processing unit 41 outputs a drive signal to the first main motor 51 and the second main motor 52 based on the calculated target angle.

  The first main motor 51 and the second main motor 52 to which the drive signal is input from the arithmetic processing unit 41 are synchronously driven to rotate in opposite directions, thereby being transferred to the first shoulder joint portion 6a and the second shoulder joint portion 6c. A driving force is supplied to drive the first shoulder joint portion 6a and the second shoulder joint portion 6c. More specifically, in FIG. 4, the first main motor 51 is driven to rotate clockwise, while the second main motor 52 is driven to rotate counterclockwise. The first drive arm portion 23 and the second drive arm portion 25 fixed to the respective output shafts by the rotational drive of the first main motor 51 and the second main motor have their swing end portions in opposite directions (close with each other). Oscillate in the direction). That is, the postures of the first shoulder joint portion 6a and the second shoulder joint portion 6c are symmetric with respect to the center line (reference line) of the main body portion 1.

At this time, the encoder provided in the first main motor 51 detects the rotation angle of the first main motor 51 at predetermined time intervals and sequentially outputs the detected detection results to the arithmetic processing unit 41. . Similarly, the encoder provided in the second main motor 52 detects the rotation angle of the second main motor 52 every predetermined time and sequentially outputs the detected detection results to the arithmetic processing unit 41.
The arithmetic processing unit 41 to which the detection result is input stores the detection result in the storage unit 42 and drives the first main motor 51 and the second main motor until the difference between the detection result and the target angle becomes zero. Will be allowed to.

On the other hand, the control unit 4 operates the first sub motor 11 and the second sub motor 12 in synchronization as follows according to the driving of the first main motor 51 and the second main motor 52.
First, the control unit 4 causes the arithmetic processing unit 41 to store the arithmetic expression stored in the storage unit 42 and the first main motor 51 in order to correspond the driving of the first shoulder joint unit 6a and the first wrist joint unit 6e. A predetermined rotation angle to be output by the first sub motor 11 is calculated in accordance with the detected rotation angle of the first main motor 51 based on the detection result of the encoder provided in the encoder. Then, the arithmetic processing unit 41 outputs a drive signal to the first sub motor 11 based on the calculated predetermined rotation angle.

In FIG. 4, the first sub-motor 11 to which the drive signal is input from the arithmetic processing unit 41 is rotated counterclockwise to supply driving force to the first wrist joint unit 6e, and the first wrist joint unit 6e Drive (see FIG. 6: step S1).
Then, the encoder provided in the first sub motor 11 detects the rotation angle A of the first sub motor 11 at every predetermined time, and outputs the detected detection result (rotation angle A) to the arithmetic processing unit 41. (Step S2).
The calculation processing unit 41 to which the detection result is input stores the detection result in the storage unit 42 and outputs a drive signal to the second sub motor 12 based on the detection result.

The second sub motor 12 to which the driving signal is input from the arithmetic processing unit 41 supplies a driving force to the second wrist joint portion 6f by rotating in the reverse direction to the first sub motor 11, that is, in the clockwise direction in FIG. Then, the second wrist joint portion 6f is driven (step S3).
Then, the encoder provided in the second sub motor 12 detects the rotation angle B of the second sub motor 12 at every predetermined time, and outputs the detected detection result (rotation angle B) to the arithmetic processing unit 41. (Step S4).

The arithmetic processing unit 41 to which the detection result is input determines whether or not the difference between the absolute value of the rotation angle A stored in the storage unit 42 and the absolute value of the detected rotation angle B has become zero (that is, It is determined whether or not the rotation angle of the first driven arm unit 24 with respect to the hand unit 3 and the rotation angle of the second driven arm unit 26 with respect to the hand unit 3 are symmetric with respect to the center line (step S5). .
If the difference is not zero, the arithmetic processing unit 41 returns to step S3 to rotate the second sub motor 12 until the difference becomes zero, and the posture of the first wrist joint portion 6e and the second wrist joint portion. The posture of 6f is symmetric with respect to the center line. On the other hand, when the difference becomes zero, the process proceeds to step S6.
In the present embodiment, since the first sub motor 11 and the second sub motor 12 are provided in the same direction and rotate in the opposite directions, the rotation angles detected by the respective encoders have different signs. Therefore, it is preferable to determine whether or not the posture of the first wrist joint portion 6e and the posture of the second wrist joint portion 6f are symmetric using the absolute value of the detected rotation angle.

  The arithmetic processing unit 41 determines whether or not the rotation angle A stored in the storage unit 42 has reached a predetermined rotation angle (step S6). If the rotation angle A has not reached the predetermined rotation angle, the arithmetic processing unit 41 returns to step S1 to drive the first sub motor 11 to rotate, and to drive the second sub motor 12 in synchronization therewith (steps S3 to S3). On the other hand, when the rotation angle A reaches the predetermined rotation angle, the arithmetic processing unit 41 ends the operations of the first sub motor 11 and the second sub motor 12 (S5).

Here, the 1st elbow joint part 6b and the 2nd elbow joint part 6d shown in FIG. 1 are the 1st shoulder joint part 6a and 2nd shoulder by the 1st main motor 51 and the 2nd main motor 52 by the mechanical structure. It is driven according to the drive of the joint part 6c and the drive of the first wrist joint part 6e and the second wrist joint part 6f by the first sub motor 11 and the second sub motor 12.
That is, the postures of the first elbow joint portion 6b and the second elbow joint portion 6d are symmetrical with the postures of the first shoulder joint portion 6a and the second shoulder joint portion 6c by the driving, and the first wrist joint by the driving. When the postures of the portion 6e and the second wrist joint portion 6f are symmetric, they are determined to be symmetric with respect to the center line.
The frog-leg arm robot R synchronizes the first arm portion 21 and the second arm portion 22 by the above-described operation, and extends the hand portion 3 to the target position while maintaining the posture of the hand portion 3 with respect to the center line. Will be allowed to.

  Next, an operation in which the hand unit 3 of the frog-leg arm robot R shown in FIG. 5 retracts backward will be described. In addition, the part which is the same as the said operation | movement to extend is omitted.

A command unit (not shown) outputs a degenerate drive command to the control unit 4. The degeneration drive command includes position information that causes the hand unit 3 to degenerate to the target position.
Upon receiving the extension drive command from the command unit, the control unit 4 causes the arithmetic processing unit 41 to calculate a target angle based on the position information and outputs a drive signal to the first main motor 51 and the second main motor 52.
The first main motor 51 to which the drive signal is input from the arithmetic processing unit 41 is rotationally driven counterclockwise in FIG. 5, whereas the second main motor 52 is rotationally driven clockwise to The swinging end portions of the first drive arm portion 23 and the second drive arm portion 25 are swung in directions opposite to each other (directions of opening each other).

On the other hand, the control unit 4 causes the arithmetic processing unit 41 to calculate a predetermined rotation angle that the first sub motor 11 should output upon detection based on the detection result of the encoder provided in the first main motor 51, A drive signal is output to the first sub motor 11.
In FIG. 5, the first sub motor 11 to which the drive signal is input rotates in the clockwise direction to supply driving force to the first wrist joint portion 6e, thereby driving the first wrist joint portion 6e. On the other hand, the second sub motor 12 supplies a driving force to the second wrist joint portion 6f by rotating in the opposite direction to the first sub motor 11, that is, counterclockwise in FIG. Drive.
Here, the 1st elbow joint part 6b and the 2nd elbow joint part 6d are driven according to the above operation | movement with the mechanical structure.

  In this way, the frog-leg-arm robot R can synchronize the first arm portion 21 and the second arm portion 22 and retract the hand portion 3 to the target position while keeping its posture constant. it can.

Therefore, according to the above-described embodiment, the first drive arm unit 23 provided in a pair and swings in the opposite directions along the horizontal plane by driving the first main motor 51 and the second main motor 52 and One end of the second drive arm unit 25 and the first drive arm unit 23 are rotatably connected to the swinging end of the first drive arm unit 23, and the first driven arm unit 24 and the second drive arm unit 25 can swing along a horizontal plane. A second driven arm portion 26 having one end rotatably connected to the swing end portion and swingable along a horizontal plane, the other end portion of the first driven arm portion 24 and the other end portion of the second driven arm portion 26. Is a frog leg arm robot R having a hand portion 3 to which the first follower arm portion 24 and the hand portion 3 are connected, and a driving force is supplied to the first wrist joint portion 6e to which the first follower arm portion 24 and the hand portion 3 are connected. 1 sub-motor 11; 2 The second sub motor 12 that supplies driving force to the second wrist joint portion 6 f to which the driven arm portion 26 and the hand portion 3 are connected, and the first main motor 51 and the second main motor 52 according to the drive. By adopting the configuration of having the control unit 4 that controls the driving of the sub motor 11 and the second sub motor 12, the first sub motor 11 and the second sub motor 11 according to the rotation angle of the first main motor 51 and the second main motor 52 are used. By driving the sub motor 12, the first arm portion 21 and the second arm portion 22 can be electrically synchronized.
Therefore, in the present embodiment, the first arm portion 21 and the second arm portion 22 are synchronized without providing a mechanical structure such as a gear at the tips of the first arm portion 21 and the second arm portion 22, and the hand portion 3. It is possible to provide a frog-leg-arm robot R that can maintain a constant posture.
In other words, in the present embodiment, dust generation due to mechanical contact between gears is prevented, so that the cover in the hand portion 3 is not necessary, and it is not necessary to provide a heavy gear that requires assembly accuracy. There is an effect that the leg arm robot R can be reduced in weight and assembled smoothly. Furthermore, in this embodiment, even if a play occurs due to the configuration, the play can be corrected to the minimum by driving the first sub motor 11 and the second sub motor 12, so that the positioning accuracy of the hand unit 3 is improved and the operation is smoothed. Is effective.

  Further, in the present embodiment, an encoder that detects the rotation angle of the first sub motor 11 and an encoder that detects the rotation angle of the second sub motor 12 are provided, and the control unit 4 is an encoder of the encoder provided in the first sub motor 11. By adopting a configuration in which the driving of the first sub motor 11 and the second sub motor 12 is synchronized based on the detection result and the detection result of the encoder provided in the second sub motor 12, the first sub motor 11 and the second sub motor 12 are used. By detecting the respective rotation angles, the first arm portion 21 and the second arm portion 22 can be accurately and smoothly synchronized.

  In the present embodiment, the control unit 4 determines the rotation angle of the first driven arm unit 24 with respect to the hand unit 3 and the second angle with respect to the hand unit 3 based on the detected rotation angle A and the detected rotation angle B. By adopting a configuration in which the first sub motor 11 and the second sub motor 12 are synchronized so that the rotation angle of the driven arm unit 26 is symmetrical with respect to the center line, the posture of the hand unit 3 is kept constant. It can be moved accurately along the reference line.

  As mentioned above, although preferred embodiment of this invention was described referring drawings, this invention is not limited to the said embodiment. Various shapes, combinations, and the like of the constituent members shown in the above-described embodiments are examples, and various modifications can be made based on design requirements and the like without departing from the gist of the present invention.

For example, in the present embodiment, it has been described that the first sub motor 11 supplies the driving force to the first wrist joint portion 6e, and the second sub motor 12 supplies the driving force to the second wrist joint portion 6f. The configuration is not limited to the above configuration, and the first sub motor 11 may supply driving force to the first wrist joint portion 6e, and the second sub motor 12 may supply driving force to the second elbow joint portion 6d. The first sub motor 11 may supply driving force to the first elbow joint portion 6b, and the second sub motor 12 may supply driving force to the second wrist joint portion 6f. Further, the present invention may be configured such that the first sub motor 11 supplies driving force to the first elbow joint portion 6b and the second sub motor 12 supplies driving force to the second elbow joint portion 6d.
When the first sub motor 11 is configured to supply driving force to the first elbow joint portion 6b and the second sub motor 12 is configured to supply driving force to the second elbow joint portion 6d, the first sub motor 11 and the second sub motor 12 are symmetrical. Therefore, if the first sub motor 11 and the second sub motor 12 are controlled synchronously as in the present embodiment, the same operation and effect can be obtained.
Further, the first sub motor 11 supplies driving force to the first elbow joint portion 6b and the second sub motor 12 supplies driving force to the second wrist joint portion 6f, or the first sub motor 11 supplies the first wrist joint portion 6e to the first elbow joint portion 6b. When the sub motor 12 is configured to supply driving force to the second elbow joint portion 6d, the posture (rotation angle) between the wrist joint portion and the elbow joint portion has a certain correspondence due to its mechanical configuration. A configuration may be employed in which a correction value is calculated based on the correspondence relationship, and the correction value is added to one of the first sub motor 11 and the second sub motor 12 to achieve synchronization.

Further, for example, in the present embodiment, it has been described that the first sub motor 11 and the second sub motor 12 are fixed on the hand portion 3, but as shown in another embodiment of FIG. It may be arranged in the driven arm part 24 or in the first drive arm part 23, and the second sub motor 12 is arranged in the second driven arm part 26 or in the second drive arm part 25. May be.
By adopting such a configuration, dust generation from the first sub motor 11 and the second sub motor 12 can be more reliably suppressed, and the frog leg arm robot R can be slimmed.

For example, the control method of the first sub motor 11 and the second sub motor 12 of the present invention is not limited to the control method described in the present embodiment.
For example, the controller 4 may be configured to simultaneously output drive signals of the same control amount to the first sub motor 11 and the second sub motor 12 by open control to achieve synchronization.

Further, for example, in the present embodiment, the first motor has been described as the first main motor 51 and the second main motor 52, but the present invention is not limited to the above configuration, and the first main motor The structure in which either one of the motor 51 and the 2nd main motor 52 is provided may be sufficient.
In this case, it is preferable to employ a configuration in which the driving of the first shoulder joint portion 6a and the second shoulder joint portion 6c is synchronized with a chain, a gear, or the like.

It is a top view which shows schematic structure of the frog-leg-arm robot in embodiment of this invention. It is a side view which shows schematic structure of the frog-leg-arm robot in embodiment of this invention. It is the block diagram which showed the function structure of the frog-leg-arm robot in embodiment of this invention. It is a figure explaining the operation | movement which the hand part of the frog-leg-arm robot in embodiment of this invention extends ahead. It is a figure explaining the operation | movement which the hand part of the frog-leg-arm robot in embodiment of this invention retracts back. It is a flowchart explaining control of the 1st sub motor and the 2nd sub motor in an embodiment of the invention. It is a side view which shows schematic structure of the frog leg arm robot in another embodiment of this invention.

Explanation of symbols

  R ... Frog leg arm robot, 3 ... hand part, 4 ... control part (control device), 6b ... first elbow joint part (first connection part), 6d ... second elbow joint part (third connection part), 6e ... 1st wrist joint part (2nd connection part), 6f ... 2nd wrist joint part (4th connection part), 11 ... 1st sub motor (2nd motor), 12 ... 2nd sub motor (3rd motor), 23 ... 1st drive arm part, 24 ... 1st driven arm part, 25 ... 2nd drive arm part, 26 ... 2nd driven arm part, 51 ... 1st main motor (1st motor), 51 ... 2nd main motor ( First motor)

Claims (2)

A first drive arm portion and a second drive arm portion that are provided in pairs and swing in opposite directions along the reference plane by driving the first motor, and a swing end portion of the first drive arm portion. One end is rotatably connected to the swinging end of the first driven arm and the second drive arm that is swingably connected along the reference plane, and one end is rotatably connected along the reference plane. A frog-leg arm robot comprising a swingable second driven arm portion, and a hand portion to which the other end portion of the first driven arm portion and the other end portion of the second driven arm portion are rotatably connected. And
A driving force is supplied to one of the first connecting portion where the first driving arm portion and the first driven arm portion are connected, and the second connecting portion where the first driven arm portion and the hand portion are connected. A second motor that
Driving force is supplied to one of the third connecting portion where the second driving arm portion and the second driven arm portion are connected and the fourth connecting portion where the second driven arm portion and the hand portion are connected. A third motor to
A control device for controlling the driving of the second motor and the third motor in accordance with the driving of the first motor ;
A first detection device for detecting a rotation angle of the second motor;
A second detection device for detecting a rotation angle of the third motor,
The control device includes a rotation angle of the first driven arm portion with respect to the hand portion and the second driven arm with respect to the hand portion based on a detection result of the first detection device and a detection result of the second detection device. A frog-leg-arm robot, wherein the driving of the second motor and the third motor is synchronized so that the rotation angle of the part is symmetrical with respect to a predetermined reference line . The second motor is provided in one of the first drive arm portion and the first driven arm portion,
2. The frog-leg-arm robot according to claim 1 , wherein the third motor is provided inside one of the second drive arm unit and the second driven arm unit.

Images