TWI480143B - Industrial robot - Google Patents
Industrial robot Download PDFInfo
- Publication number
- TWI480143B TWI480143B TW098128550A TW98128550A TWI480143B TW I480143 B TWI480143 B TW I480143B TW 098128550 A TW098128550 A TW 098128550A TW 98128550 A TW98128550 A TW 98128550A TW I480143 B TWI480143 B TW I480143B
- Authority
- TW
- Taiwan
- Prior art keywords
- motor
- drive
- horizontal
- drive motor
- motors
- Prior art date
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J15/00—Gripping heads and other end effectors
- B25J15/0014—Gripping heads and other end effectors having fork, comb or plate shaped means for engaging the lower surface on a object to be transported
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
- B25J9/126—Rotary actuators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G49/00—Conveying systems characterised by their application for specified purposes not otherwise provided for
- B65G49/05—Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles
- B65G49/06—Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles for fragile sheets, e.g. glass
- B65G49/061—Lifting, gripping, or carrying means, for one or more sheets forming independent means of transport, e.g. suction cups, transport frames
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16H—GEARING
- F16H25/00—Gearings comprising primarily only cams, cam-followers and screw-and-nut mechanisms
- F16H25/08—Gearings comprising primarily only cams, cam-followers and screw-and-nut mechanisms for interconverting rotary motion and reciprocating motion
- F16H25/14—Gearings comprising primarily only cams, cam-followers and screw-and-nut mechanisms for interconverting rotary motion and reciprocating motion with reciprocation perpendicular to the axis of rotation
-
- H—ELECTRICITY
- H01—ELECTRIC ELEMENTS
- H01L—SEMICONDUCTOR DEVICES NOT COVERED BY CLASS H10
- H01L21/00—Processes or apparatus adapted for the manufacture or treatment of semiconductor or solid state devices or of parts thereof
- H01L21/67—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere
- H01L21/677—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations
- H01L21/67739—Apparatus specially adapted for handling semiconductor or electric solid state devices during manufacture or treatment thereof; Apparatus specially adapted for handling wafers during manufacture or treatment of semiconductor or electric solid state devices or components ; Apparatus not specifically provided for elsewhere for conveying, e.g. between different workstations into and out of processing chamber
- H01L21/67742—Mechanical parts of transfer devices
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Condensed Matter Physics & Semiconductors (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Computer Hardware Design (AREA)
- Microelectronics & Electronic Packaging (AREA)
- Power Engineering (AREA)
- Manipulator (AREA)
Description
本發明係關於一種搬送特定之搬送對象物之產業用機器人。The present invention relates to an industrial robot that transports a specific object to be transported.
一直以來,搬送特定之搬送對象物之產業用機器人得以廣泛使用。作為該種產業用機器人,已知有包括搭載搬送對象物之機械手、保持機械手之臂、及使臂上下運動之滾珠螺桿在內的產業用機器人(例如,參照專利文獻1)。於該專利文獻1所記載之產業用機器人中,滾珠螺桿上連結有一台馬達,滾珠螺桿係由一台馬達驅動。Industrial robots that transport specific objects to be transported have been widely used. As such an industrial robot, an industrial robot including a robot to which a transfer object is mounted, an arm for holding a robot, and a ball screw that moves the arm up and down is known (for example, see Patent Document 1). In the industrial robot described in Patent Document 1, a motor is coupled to the ball screw, and the ball screw is driven by one motor.
另外,亦已知一種並非對搬送對象物進行搬送之產業用機器人、但搭載機器人之本體部分之基座能於水平方向移動之產業用機器人(例如,參照專利文獻2)。該專利文獻2中記載之產業用機器人包括:用以使基座於水平方向移動之齒條及小齒輪、以及用以旋轉驅動小齒輪之一台馬達。In addition, an industrial robot that can move the gantry of the main body of the robot in the horizontal direction (for example, see Patent Document 2) is also known. The industrial robot described in Patent Document 2 includes a rack and pinion for moving the susceptor in the horizontal direction, and a motor for rotating the pinion.
[專利文獻1]日本專利特開2006-102886號公報[Patent Document 1] Japanese Patent Laid-Open Publication No. 2006-102886
[專利文獻2]日本專利特開平6-106487號公報[Patent Document 2] Japanese Patent Laid-Open No. Hei 6-106487
如液晶顯示器用玻璃基板等般,在由產業用機器人所搬送之搬送對象物中,存在有在逐年大型化者。隨著該種搬送對象物之大型化,搬送大型化的搬送對象物之產業用機器人具有大型化之傾向。而且,隨著產業用機器人之大型化,產業用機器人之成本具有增大之傾向。In the case of a glass substrate for a liquid crystal display, the object to be transported by the industrial robot is large in size every year. With the increase in the size of the object to be transported, the industrial robot that transports the large-sized object to be transported has a tendency to increase in size. Further, with the increase in the size of industrial robots, the cost of industrial robots tends to increase.
因此,本發明之課題在於提供一種於搬送大型化之搬送對象物之情況下亦能實現小型化、且能降低成本之產業用機器人。Therefore, an object of the present invention is to provide an industrial robot that can be reduced in size and can reduce costs even when a large-sized object to be transported is transported.
為解決上述課題,本發明之產業用機器人之特徵在於,包括:搭載搬送對象物之機械手;連結有機械手之臂;及支持臂之支持構件,並且包括:使支持構件上下運動之上下驅動機構以及控制上下驅動機構之控制部;上下驅動機構包括複數台驅動用馬達,控制部包括控制複數台驅動用馬達之馬達控制部,馬達控制部係:藉由速度控制或者位置控制之任一者、與轉矩控制來控制複數台驅動用馬達中之若干台驅動用馬達即第一驅動用馬達;藉由轉矩控制來控制除第一驅動用馬達以外之其餘的驅動用馬達即第二驅動用馬達。另外,為解決上述課題,本發明之產業用機器人之特徵在於,包括:搭載搬送對象物之機械手;連結有機械手之臂;及支持臂之支持構件,並且包括:使支持構件於水平方向移動之水平驅動機構以及控制水平驅動機構之控制部;水平驅動機構包括複數台驅動用馬達,控制部包括控制複數台驅動用馬達之馬達控制部,馬達控制部係:藉由速度控制或者位置控制之任一者、與轉矩控制來控制複數台驅動用馬達中之若干台驅動用馬達即第一驅動用馬達;藉由轉矩控制來控制除第一驅動用馬達以外之其餘的驅動用馬達即第二驅動用馬達。進而,為解決上述課題,本發明之產業用機器人之特徵在於,包括:搭載搬送對象物之機械手;連結有機械手之臂;及支持臂之支持構件,並且包括:使支持構件以將上下方向當作軸方向之特定之中心軸作為中心而旋轉的旋轉驅動機構;以及控制旋轉驅動機構之控制部;旋轉驅動機構包括複數台驅動用馬達,控制部包括控制複數台驅動用馬達之馬達控制部,馬達控制部係:藉由速度控制或者位置控制之任一者、與轉矩控制來控制複數台驅動用馬達中之若干台驅動用馬達即第一驅動用馬達;藉由轉矩控制來控制除第一驅動用馬達以外之其餘的驅動用馬達即第二驅動用馬達。In order to solve the above problems, the industrial robot according to the present invention includes: a robot that mounts an object to be transported; an arm that couples the robot; and a support member that supports the arm, and includes: driving the support member up and down to move up and down a mechanism and a control unit that controls the upper and lower drive mechanisms; the upper and lower drive mechanisms include a plurality of drive motors, and the control unit includes a motor control unit that controls the plurality of drive motors, and the motor control unit: either by speed control or position control And the first drive motor, which is a plurality of drive motors of the plurality of drive motors, and the second drive for controlling the other drive motors other than the first drive motor by torque control; Use a motor. In addition, the industrial robot according to the present invention includes: a robot that mounts an object to be transported; an arm that couples the robot; and a support member that supports the arm, and includes: the support member is horizontally a horizontal driving mechanism for moving and a control unit for controlling the horizontal driving mechanism; the horizontal driving mechanism includes a plurality of driving motors, and the control unit includes a motor control unit for controlling a plurality of driving motors, and the motor control unit is: speed control or position control Any one of the plurality of driving motors, that is, the first driving motor, which is controlled by the torque control; and the remaining driving motors other than the first driving motor are controlled by the torque control That is, the second drive motor. Further, in order to solve the above problems, the industrial robot according to the present invention includes: a robot that mounts an object to be transported; an arm that couples the robot; and a support member that supports the arm, and includes: the support member is placed up and down a rotation drive mechanism that rotates as a center axis as a specific central axis; and a control unit that controls the rotation drive mechanism; the rotation drive mechanism includes a plurality of drive motors, and the control unit includes a motor control that controls the plurality of drive motors The motor control unit controls the first drive motor, which is a plurality of drive motors of the plurality of drive motors, by the speed control or the position control, and the torque control The second drive motor, which is the other drive motor except the first drive motor, is controlled.
隨著搬送對象物之大型化,上下驅動機構、水平驅動機構及/或旋轉驅動機構所要求之驅動用馬達之總容量變大。因此,在用一台驅動用馬達來驅動上下驅動機構、水平驅動機構及/或旋轉驅動機構時,必需使用外形較大的馬達,從而產業用機器人有大型化之虞。As the object to be transported is enlarged, the total capacity of the drive motor required for the vertical drive mechanism, the horizontal drive mechanism, and/or the rotary drive mechanism is increased. Therefore, when the upper and lower drive mechanism, the horizontal drive mechanism, and/or the rotary drive mechanism are driven by one drive motor, it is necessary to use a motor having a large outer shape, and the industrial robot has a large size.
本發明之產業用機器人中,上下驅動機構包括複數台驅動用馬達。另外,本發明之產業用機器人中,水平驅動機構包括複數台驅動用馬達,旋轉驅動機構包括複數台驅動用馬達。因此,即便在上下驅動機構所要求之驅動用馬達之總容量較大的情況下,亦可使用外形較小的驅動用馬 達,即便在水平驅動機構所要求之驅動用馬達之總容量較大的情況下,亦可使用外形較小的驅動用馬達,即便在旋轉驅動機構所要求之驅動用馬達之總容量較大的情況下,亦可使用外形較小的驅動用馬達。又,與使用外形較大的一台驅動用馬達之情形相比,在使用外形較小的複數台驅動用馬達的情況下,驅動用馬達之配置之自由度變高。因此,本發明中,儘管搬送較大的搬送對象物,亦能實現產業用機器人之小型化。In the industrial robot of the present invention, the vertical drive mechanism includes a plurality of drive motors. Further, in the industrial robot of the present invention, the horizontal drive mechanism includes a plurality of drive motors, and the rotary drive mechanism includes a plurality of drive motors. Therefore, even when the total capacity of the drive motor required for the upper and lower drive mechanisms is large, a drive horse having a small outer shape can be used. Even when the total capacity of the drive motor required by the horizontal drive mechanism is large, a drive motor having a small outer shape can be used, even if the total capacity of the drive motor required by the rotary drive mechanism is large. In this case, a smaller drive motor can also be used. In addition, when a plurality of driving motors having a small outer shape are used, the degree of freedom in the arrangement of the driving motors is increased as compared with the case of using a single driving motor having a large outer shape. Therefore, in the present invention, the industrial robot can be downsized even if a large object to be transported is transported.
另外,在驅動用馬達之容量超過特定之容量時,驅動用馬達之價格會急遽升高,但本發明中,由於可使用容量較小的驅動用馬達,故即便在使用複數台驅動用馬達的情況下,亦能降低產業用機器人之成本。Further, when the capacity of the drive motor exceeds a specific capacity, the price of the drive motor is rapidly increased. However, in the present invention, since a drive motor having a small capacity can be used, even if a plurality of drive motors are used, In this case, the cost of industrial robots can also be reduced.
進而,本發明中,由於可使用容量較小的驅動用馬達,故從一台驅動用馬達傳遞之動力變小。因此,可減小對傳遞驅動用馬達之動力之齒輪等的動力傳遞機構之傳遞動力,從而可簡化動力傳遞機構之構成。而且,可抑制動力傳遞機構之損傷。Further, in the present invention, since the drive motor having a small capacity can be used, the power transmitted from one drive motor is reduced. Therefore, the transmission power to the power transmission mechanism such as the gear that transmits the power of the drive motor can be reduced, and the configuration of the power transmission mechanism can be simplified. Moreover, damage to the power transmission mechanism can be suppressed.
另一方面,在使用複數台驅動用馬達時,由於旋轉速度之差等原因而有產生如下情況之虞,即,某一驅動用馬達之驅動轉矩成為其他驅動用馬達之較大的負載。在本發明中,馬達控制部係:藉由速度控制或者位置控制之任一者、與轉矩控制來控制複數台驅動用馬達中之若干台驅動用馬達即第一驅動用馬達;藉由轉矩控制來控制除第一驅動用馬達以外之其餘的驅動用馬達即第二驅動用馬達。因此,第二驅動用馬達之旋轉速度或者旋轉位置會不受控制,故第二驅動用馬達隨從第一驅動用馬達之旋轉速度或旋轉位置而旋轉。其結果,即便使用複數台驅動用馬達,亦能防止某一驅動用馬達之驅動轉矩成為其他驅動用馬達之較大的負載。On the other hand, when a plurality of driving motors are used, there is a case where the driving torque of one of the driving motors becomes a large load of the other driving motor due to a difference in the rotational speed or the like. In the present invention, the motor control unit controls one of the plurality of driving motors, that is, the first driving motor, by one of speed control or position control, and torque control; The moment control controls the second drive motor other than the first drive motor. Therefore, the rotational speed or the rotational position of the second drive motor is not controlled, so that the second drive motor rotates in accordance with the rotational speed or rotational position of the first drive motor. As a result, even if a plurality of driving motors are used, it is possible to prevent the driving torque of one of the driving motors from becoming a large load of the other driving motors.
在本發明中,較好的是第一驅動用馬達為一台驅動用馬達。如此構成時,能以一台驅動用馬達為基準而控制其餘的驅動用馬達。因此,例如藉由控制一台第一驅動用馬達之旋轉速度、且不控制其餘的第二驅動用馬達之旋轉速度之方式,可使第二驅動用馬達隨從一台第一驅動用馬達之旋轉速度進行旋轉。其結果為,能可靠地防止某一驅動用馬達之驅動轉矩成為其他驅動用馬達之較大的負載。In the present invention, it is preferable that the first drive motor is a single drive motor. According to this configuration, the remaining drive motors can be controlled based on one drive motor. Therefore, for example, by controlling the rotational speed of one of the first driving motors and not controlling the rotational speeds of the remaining second driving motors, the second driving motor can be rotated by a first driving motor. The speed is rotated. As a result, it is possible to reliably prevent the driving torque of one of the driving motors from becoming a large load of the other driving motor.
另外,為解決上述課題,本發明之產業用機器人之特徵在於,包括:搭載搬送對象物之機械手;連結有機械手之臂、及支持臂之支持構件;並且包括:使支持構件於水平方向移動之水平驅動機構;以及控制水平驅動機構之控制部;水平驅動機構包括複數台驅動用馬達,控制部包括控制複數台驅動用馬達之水平馬達控制部,複數台驅動用馬達之各個包括檢測驅動用馬達之旋轉速度之速度檢測機構,將複數台驅動用馬達中之若干台驅動用馬達作為第一水平驅動用馬達,將除第一水平驅動用馬達以外之其餘的 驅動用馬達作為第二水平驅動用馬達,水平馬達控制部藉由速度控制或者位置控制之任一者、與轉矩控制來控制第一水平驅動用馬達,且計算基準脈衝數與檢測出之脈衝數之差,其中基準脈衝數係藉由作為第一水平驅動用馬達之速度檢測機構之第一速度檢測機構所檢測出之從支持構件之特定之基準位置至停止預定位置為止的脈衝數,檢測出之脈衝數係由第一速度檢測機構所檢測出之從支持構件之基準位置之實際的脈衝數;當該差為特定之值以下時,藉由速度控制或者位置控制之任一者、與轉矩控制來控制第二水平驅動用馬達,並且當基準脈衝數與檢測脈衝數之差較特定之值大時,藉由轉矩控制來控制第二水平驅動用馬達。In addition, the industrial robot according to the present invention includes: a robot that mounts a transfer object; a support arm that connects the arm of the robot and the support arm; and includes: the support member is horizontally a horizontal driving mechanism for moving; and a control unit for controlling the horizontal driving mechanism; the horizontal driving mechanism includes a plurality of driving motors, the control unit includes a horizontal motor control unit that controls the plurality of driving motors, and each of the plurality of driving motors includes a detection driving The speed detecting means of the rotational speed of the motor uses a plurality of driving motors of the plurality of driving motors as the first horizontal driving motor, and the rest of the first horizontal driving motor The driving motor is a second horizontal driving motor, and the horizontal motor control unit controls the first horizontal driving motor by either the speed control or the position control, and calculates the reference pulse number and the detected pulse. The difference between the numbers, wherein the number of reference pulses is detected by the number of pulses from the specific reference position of the support member to the predetermined stop position detected by the first speed detecting means of the speed detecting means of the first horizontal drive motor The number of pulses is the actual number of pulses detected by the first speed detecting means from the reference position of the supporting member; when the difference is below a specific value, either by speed control or position control, Torque control controls the second horizontal drive motor, and when the difference between the number of reference pulses and the number of detected pulses is larger than a specific value, the second horizontal drive motor is controlled by torque control.
隨著搬送對象物之大型化,水平驅動機構所要求之驅動用馬達之總容量變大,故在用一台驅動用馬達來驅動水平驅動機構時,必需使用外形較大的馬達,從而產業用機器人有大型化之虞。本發明之產業用機器人中,水平驅動機構包括複數台驅動用馬達。因此,即便在水平驅動機構所要求之驅動用馬達之總容量較大的情況下,亦可使用外形較小的驅動用馬達。又,與使用外形較大的一台驅動用馬達之情形相比,在使用外形較小的複數台驅動用馬達的情況下,驅動用馬達之配置之自由度變高。因此,本發明中,儘管搬送較大的搬送對象物,亦能實現產業用機器人之小型化。另外,在驅動用馬達之容量超過特定之容量時,驅動用馬達之價格會急遽升高,但本發明中,由於可使用容量較小的驅動用馬達,故即便在使用複數台驅動用馬達的情況下,亦能降低產業用機器人之成本。進而,本發明中,由於可使用容量較小的驅動用馬達,故從一台驅動用馬達傳遞之動力變小。因此,可減小對傳遞驅動用馬達之動力之齒輪等的動力傳遞機構之傳遞動力,從而可簡化動力傳遞機構之構成。而且,可抑制動力傳遞機構之損傷。另一方面,在使用複數台驅動用馬達時,由於旋轉速度之差等原因而有產生如下情況之虞,即,某一驅動用馬達之驅動轉矩成為其他驅動用馬達之較大的負載。在本發明中,水平馬達控制部藉由速度控制或者位置控制之任一者、與轉矩控制來控制第一水平驅動用馬達,且計算基準脈衝數與檢測出之脈衝數之差,其中基準脈衝數係藉由作為第一水平驅動用馬達之速度檢測機構之第一速度檢測機構所檢測出之從支持構件之特定之基準位置至停止預定位置為止的脈衝數,檢測出之脈衝數係由第一速度檢測機構所檢測出之從支持構件之基準位置之實際的脈衝數;當該差為特定之值以下時,藉由速度控制或者位置控制之任一者、與轉矩控制來控制第二水平驅動用馬達,並且當基準脈衝數與檢測脈衝數之差較特定之值大時,藉由轉矩控制來控制第二水平驅動用馬達。因此,當基準脈衝數與檢測脈衝數之差較特定之值大時,第二水平驅動用馬達之旋轉 速度或者旋轉位置會不受控制,故第二水平驅動用馬達隨從第一水平驅動用馬達之旋轉速度或旋轉位置而旋轉。其結果,即便使用複數台驅動用馬達,亦能防止某一驅動用馬達之驅動轉矩成為其他驅動用馬達之較大的負載。另外,當基準脈衝數與檢測脈衝數之差為特定之值以下時,在第二水平驅動用馬達停止前,控制第二水平驅動用馬達之旋轉速度或旋轉位置,以使得用以將第一水平驅動用馬達及第二水平驅動用馬達之動力傳遞給支持構件之動力傳遞機構在停止時齒隙消失。With the increase in the size of the object to be transported, the total capacity of the drive motor required by the horizontal drive mechanism is increased. Therefore, when the horizontal drive mechanism is driven by one drive motor, it is necessary to use a motor having a large outer shape for industrial use. Robots have a large scale. In the industrial robot of the present invention, the horizontal drive mechanism includes a plurality of drive motors. Therefore, even when the total capacity of the drive motor required for the horizontal drive mechanism is large, a drive motor having a small outer shape can be used. In addition, when a plurality of driving motors having a small outer shape are used, the degree of freedom in the arrangement of the driving motors is increased as compared with the case of using a single driving motor having a large outer shape. Therefore, in the present invention, the industrial robot can be downsized even if a large object to be transported is transported. Further, when the capacity of the drive motor exceeds a specific capacity, the price of the drive motor is rapidly increased. However, in the present invention, since a drive motor having a small capacity can be used, even if a plurality of drive motors are used, In this case, the cost of industrial robots can also be reduced. Further, in the present invention, since the drive motor having a small capacity can be used, the power transmitted from one drive motor is reduced. Therefore, the transmission power to the power transmission mechanism such as the gear that transmits the power of the drive motor can be reduced, and the configuration of the power transmission mechanism can be simplified. Moreover, damage to the power transmission mechanism can be suppressed. On the other hand, when a plurality of driving motors are used, there is a case where the driving torque of one of the driving motors becomes a large load of the other driving motor due to a difference in the rotational speed or the like. In the present invention, the horizontal motor control unit controls the first horizontal drive motor by either speed control or position control, and calculates a difference between the number of reference pulses and the number of detected pulses, wherein the reference The number of pulses is determined by the number of pulses detected from the specific reference position of the support member to the predetermined stop position detected by the first speed detecting means of the speed detecting means of the first horizontal drive motor. The actual number of pulses detected by the first speed detecting means from the reference position of the supporting member; when the difference is equal to or less than a specific value, the speed control or the position control is controlled by the torque control The two horizontal drive motors, and when the difference between the number of reference pulses and the number of detected pulses is larger than a specific value, the second horizontal drive motor is controlled by torque control. Therefore, when the difference between the number of reference pulses and the number of detection pulses is larger than a specific value, the rotation of the second horizontal driving motor The speed or the rotational position is not controlled, so the second horizontal drive motor rotates in accordance with the rotational speed or rotational position of the first horizontal drive motor. As a result, even if a plurality of driving motors are used, it is possible to prevent the driving torque of one of the driving motors from becoming a large load of the other driving motors. Further, when the difference between the number of reference pulses and the number of detection pulses is equal to or less than a specific value, before the second horizontal drive motor is stopped, the rotational speed or rotational position of the second horizontal drive motor is controlled so that the first The power transmission mechanism that transmits the power of the horizontal drive motor and the second horizontal drive motor to the support member disappears when the stop occurs.
另外,為解決上述課題,本發明之產業用機器人之特徵在於,包括:搭載搬送對象物之機械手;連結有機械手之臂、及支持臂之支持構件;並且包括:使支持構件以一將上下方向當作軸方向之特定之中心軸作為中心而旋轉的旋轉驅動機構;以及控制旋轉驅動機構之控制部;旋轉驅動機構包括複數台驅動用馬達,控制部包括控制複數台驅動用馬達之旋轉馬達控制部,複數台驅動用馬達之各個包括檢測驅動用馬達之旋轉速度之速度檢測機構,將複數台驅動用馬達中之若干台驅動用馬達作為第一旋轉驅動用馬達,將除第一旋轉驅動用馬達以外之其餘的驅動用馬達作為第二旋轉驅動用馬達,旋轉馬達控制部藉由速度控制或者位置控制之任一者、與轉矩控制來控制第一旋轉驅動用馬達、且計算基準脈衝數與檢測出之脈衝數之差,其中基準脈衝數係藉由作為第一旋轉驅動用馬達之速度檢測機構之第一速度檢測機構所檢測出之從支持構件之特定之旋轉基準位置至停止預定位置為止的脈衝數,檢測出之脈衝數係由第一速度檢測機構所檢測出之從支持構件之旋轉基準位置之實際的脈衝數;當該差為特定之值以下時,藉由速度控制或者位置控制之任一者、與轉矩控制來控制第二旋轉驅動用馬達,並且當基準脈衝數與檢測脈衝數之差較特定之值大時,藉由轉矩控制來控制第二旋轉驅動用馬達。。In addition, the industrial robot according to the present invention includes: a robot that mounts an object to be transported; a support arm that connects the arm of the robot and the support arm; and includes: a vertical driving mechanism that rotates around a specific central axis of the axial direction as a center; and a control unit that controls the rotational driving mechanism; the rotational driving mechanism includes a plurality of driving motors, and the control unit includes a rotation that controls the plurality of driving motors Each of the plurality of driving motors includes a speed detecting mechanism that detects a rotational speed of the driving motor, and a plurality of driving motors of the plurality of driving motors are used as the first rotational driving motor, and the first rotation is performed. The other drive motor other than the drive motor is used as the second rotary drive motor, and the rotary motor control unit controls the first rotary drive motor by the speed control or the position control, and calculates the reference. The difference between the number of pulses and the number of detected pulses, wherein the number of reference pulses is The number of pulses detected from the specific rotation reference position of the support member to the predetermined stop position detected by the first speed detecting means of the speed detecting means of the rotation drive motor, and the detected number of pulses is detected by the first speed detecting means The actual number of pulses from the rotation reference position of the support member; when the difference is equal to or less than a specific value, the second rotation drive motor is controlled by either the speed control or the position control, and the torque control Further, when the difference between the number of reference pulses and the number of detected pulses is larger than a specific value, the second rotary drive motor is controlled by torque control. .
隨著搬送對象物之大型化,旋轉驅動機構所要求之驅動用馬達之總容量變大,故在用一台驅動用馬達來驅動旋轉驅動機構時,必需使用外形較大的馬達,從而產業用機器人有大型化之虞。本發明之產業用機器人中,旋轉驅動機構包括複數台驅動用馬達。因此,即便在旋轉驅動機構所要求之驅動用馬達之總容量較大的情況下,亦可使用外形較小的驅動用馬達。又,與使用外形較大的一台驅動用馬達之情形相比,在使用外形較小的複數台驅動用馬達的情況下,驅動用馬達之配置之自由度變高。因此,本發明中,儘管搬送較大的搬送對象物,亦能實現產業用機器人之小型化。另外,在驅動用馬達之容量超過特定之容量時,驅動用馬達之價格會急遽升高,但本發明中,由於可使用容量較小的驅動用馬達,故即便在使用複數台驅動用 馬達的情況下,亦能降低產業用機器人之成本。進而,本發明中,由於可使用容量較小的驅動用馬達,故從一台驅動用馬達傳遞之動力變小。因此,可減小對傳遞驅動用馬達之動力之齒輪等的動力傳遞機構之傳遞動力,從而可簡化動力傳遞機構之構成。而且,可抑制動力傳遞機構之損傷。另一方面,在使用複數台驅動用馬達時,由於旋轉速度之差等原因而有產生如下情況之虞,即,某一驅動用馬達之驅動轉矩成為其他驅動用馬達之較大的負載。在本發明中,旋轉馬達控制部藉由速度控制或者位置控制之任一者、與轉矩控制來控制第一旋轉驅動用馬達、且計算基準脈衝數與檢測出之脈衝數之差,其中基準脈衝數係藉由作為第一旋轉驅動用馬達之速度檢測機構之第一速度檢測機構所檢測出之從支持構件之特定之旋轉基準位置至停止預定位置為止的脈衝數,檢測出之脈衝數係由第一速度檢測機構所檢測出之從支持構件之旋轉基準位置之實際的脈衝數;當該差為特定之值以下時,藉由速度控制或者位置控制之任一者、與轉矩控制來控制第二旋轉驅動用馬達,並且當基準脈衝數與檢測脈衝數之差較特定之值大時,藉由轉矩控制來控制第二旋轉驅動用馬達。因此,當基準脈衝數與檢測脈衝數之差較特定之值大時,第二旋轉驅動用馬達之旋轉速度或者旋轉位置會不受控制,故第二旋轉驅動用馬達隨從第一旋轉驅動用馬達之旋轉速度或旋轉位置而旋轉。其結果,即便使用複數台驅動用馬達,亦能防止某一驅動用馬達之驅動轉矩成為其他驅動用馬達之較大的負載。另外,當基準脈衝數與檢測脈衝數之差為特定之值以下時,在第二旋轉驅動用馬達停止前,控制第二旋轉驅動用馬達之旋轉速度或旋轉位置,以使得用以將第一旋轉驅動用馬達及第二旋轉驅動用馬達之動力傳遞給支持構件之動力傳遞機構在停止時齒隙消失。With the increase in the size of the object to be transported, the total capacity of the drive motor required for the rotary drive mechanism is increased. Therefore, when the rotary drive mechanism is driven by one drive motor, it is necessary to use a motor having a large outer shape for industrial use. Robots have a large scale. In the industrial robot of the present invention, the rotary drive mechanism includes a plurality of drive motors. Therefore, even when the total capacity of the drive motor required for the rotary drive mechanism is large, a drive motor having a small outer shape can be used. In addition, when a plurality of driving motors having a small outer shape are used, the degree of freedom in the arrangement of the driving motors is increased as compared with the case of using a single driving motor having a large outer shape. Therefore, in the present invention, the industrial robot can be downsized even if a large object to be transported is transported. Further, when the capacity of the drive motor exceeds a specific capacity, the price of the drive motor is rapidly increased. However, in the present invention, since a drive motor having a small capacity can be used, even when a plurality of drive motors are used, In the case of a motor, the cost of industrial robots can also be reduced. Further, in the present invention, since the drive motor having a small capacity can be used, the power transmitted from one drive motor is reduced. Therefore, the transmission power to the power transmission mechanism such as the gear that transmits the power of the drive motor can be reduced, and the configuration of the power transmission mechanism can be simplified. Moreover, damage to the power transmission mechanism can be suppressed. On the other hand, when a plurality of driving motors are used, there is a case where the driving torque of one of the driving motors becomes a large load of the other driving motor due to a difference in the rotational speed or the like. In the present invention, the rotation motor control unit controls the first rotation drive motor by either the speed control or the position control, and calculates the difference between the number of reference pulses and the number of detected pulses. The number of pulses is detected by the number of pulses detected from the specific rotation reference position of the support member to the predetermined stop position detected by the first speed detecting means of the speed detecting means of the first rotation driving motor. The actual number of pulses detected by the first speed detecting means from the rotational reference position of the support member; when the difference is below a specific value, by either speed control or position control, and torque control The second rotation drive motor is controlled, and when the difference between the reference pulse number and the detection pulse number is larger than a specific value, the second rotation drive motor is controlled by torque control. Therefore, when the difference between the number of reference pulses and the number of detection pulses is larger than a specific value, the rotation speed or the rotational position of the second rotation drive motor is not controlled, so the second rotation drive motor follows the first rotation drive motor. Rotate at the speed of rotation or the position of rotation. As a result, even if a plurality of driving motors are used, it is possible to prevent the driving torque of one of the driving motors from becoming a large load of the other driving motors. Further, when the difference between the number of reference pulses and the number of detection pulses is equal to or less than a specific value, before the second rotation drive motor is stopped, the rotation speed or the rotation position of the second rotation drive motor is controlled so as to be used for the first The power transmission mechanism that transmits the power of the rotation drive motor and the second rotation drive motor to the support member disappears when the stop occurs.
如上所述,對於本發明之產業用機器人,即便在搬送大型化之搬送對象物之情況下,亦能實現產業用機器人之小型化及降低產業用機器人之成本。As described above, the industrial robot of the present invention can reduce the size of the industrial robot and reduce the cost of the industrial robot even when the large-sized transport object is transported.
以下,根據圖式來說明本發明之實施形態。Hereinafter, embodiments of the present invention will be described based on the drawings.
(產業用機器人之概略構成)(summary structure of industrial robot)
圖1係本發明之實施形態之產業用機器人1之俯視圖。圖2係從圖1之E-E方向表示產業用機器人1之示圖。圖3係從圖1之F-F方向表示產業用機器人1之示圖。Fig. 1 is a plan view of an industrial robot 1 according to an embodiment of the present invention. Fig. 2 is a view showing the industrial robot 1 from the E-E direction of Fig. 1 . Fig. 3 is a view showing the industrial robot 1 from the F-F direction of Fig. 1.
本實施形態之產業用機器人1(以下,稱為「機器人1」)係用以搬送作為搬送對象物之液晶顯示器用玻璃基板2(以下,稱為「基板2」)之機器人。本實施形態之機器人1係特別適合於大型的基板2之搬送之大型機器人,例如搬送一邊長約為3m之大致正方形之基板2。另外,搬送對象物並不限定於基板2,亦可為半導體晶圓等。The industrial robot 1 (hereinafter referred to as "the robot 1") of the present embodiment is a robot for transporting the glass substrate 2 for liquid crystal display (hereinafter referred to as "substrate 2") as a transfer target. The robot 1 of the present embodiment is particularly suitable for a large-sized robot that transports a large-sized substrate 2, for example, a substantially square substrate 2 having a length of about 3 m. Further, the object to be transported is not limited to the substrate 2, and may be a semiconductor wafer or the like.
如圖1~圖3所示,該機器人1包括:搭載基板2之兩個機械手3;於前端側連結有兩個機械手3之各個的兩條臂4;支持兩條臂4之本體部5;及於水平方向可移動地支持本體部5之基座構件6。本體部5包括:支持兩條臂4之基端側並能上下運動之支持構件7;用以於上下方向可移動地支持著支持構件7之柱狀構件8;構成本體部5之下端部分並能相對於基座構件6而水平移動之基台9;及固定有柱狀構件8之下端並能相對於基台9而回旋之回旋構件10。As shown in FIGS. 1 to 3, the robot 1 includes two robots 3 on which the substrate 2 is mounted, two arms 4 connected to each of the two robots 3 on the distal end side, and a body portion that supports the two arms 4. 5; and movably supporting the base member 6 of the body portion 5 in the horizontal direction. The body portion 5 includes: a support member 7 that supports the base end side of the two arms 4 and is movable up and down; a columnar member 8 for movably supporting the support member 7 in the up and down direction; and a lower end portion of the body portion 5 and A base 9 that can move horizontally with respect to the base member 6; and a swing member 10 to which the lower end of the columnar member 8 is fixed and can be rotated with respect to the base 9.
如上所述,本實施形態之機器人1為大型之機器人。例如,機器人1之高度約為7m,支持構件7之上下方向之行程(移動量)約為5m。另外,例如,機械手3之水平方向之行程約為5.5m。As described above, the robot 1 of the present embodiment is a large robot. For example, the height of the robot 1 is about 7 m, and the stroke (moving amount) of the support member 7 in the up and down direction is about 5 m. Further, for example, the horizontal direction of the robot 3 is about 5.5 m.
機械手3包括用以搭載基板2之複數個爪部12。機械手3之基端可旋動地連結於臂4之前端。臂4具有兩個關節部13,以整體可伸縮之方式構成。另外,臂4之基端固定於支持構件7上。The robot 3 includes a plurality of claws 12 for mounting the substrate 2. The base end of the robot 3 is rotatably coupled to the front end of the arm 4. The arm 4 has two joint portions 13 which are integrally stretchable. Further, the base end of the arm 4 is fixed to the support member 7.
本實施形態中,兩個機械手3與兩條臂4配置成於上下方向上重疊。即,本實施形態之機器人1為雙臂型機器人。另外,機器人1亦可為包括一個機械手3與一條臂4之單臂型機器人。In the present embodiment, the two robots 3 and the two arms 4 are arranged to overlap in the vertical direction. That is, the robot 1 of the present embodiment is a two-arm type robot. Further, the robot 1 may be a one-arm type robot including a robot 3 and an arm 4.
又,機器人1包括:使支持構件7上下運動之上下驅動機構16(參照圖4);使本體部5朝水平方向移動之水平驅動機構17(參照圖7);以及使回旋構件10相對於基台9而回旋之旋轉驅動機構18(參照圖7)。以下,對上下驅動機構16、水平驅動機構17及旋轉驅動機構18之構成以及其周邊部分之構成進行說明。Further, the robot 1 includes a vertical drive mechanism 16 for moving the support member 7 up and down (see FIG. 4), a horizontal drive mechanism 17 for moving the main body portion 5 in the horizontal direction (refer to FIG. 7), and a counter-rotating member 10 with respect to the base. The rotary drive mechanism 18 (see Fig. 7) which is rotated by the table 9. Hereinafter, the configuration of the vertical drive mechanism 16, the horizontal drive mechanism 17, and the rotary drive mechanism 18, and the configuration of the peripheral portion thereof will be described.
(上下驅動機構及其周邊部之構成)(Composition of the upper and lower drive mechanisms and their peripheral parts)
圖4係從圖1之F-F方向表示支持構件7及上下驅動機構16之示圖。圖5係從圖4之G-G方向表示支持構件7、柱狀構件8及上下驅動機構16之示圖。圖6係從圖4之H-H方向表示上下驅動機構16之示圖。Fig. 4 is a view showing the support member 7 and the vertical drive mechanism 16 from the F-F direction of Fig. 1. Fig. 5 is a view showing the support member 7, the columnar member 8, and the vertical drive mechanism 16 from the G-G direction of Fig. 4 . Fig. 6 is a view showing the vertical drive mechanism 16 from the H-H direction of Fig. 4.
如圖5所示,上下驅動機構16配置於柱狀構件8之側方(圖5之柱狀構件8之下方)。該上下驅動機構16包括:兩台上下驅動用馬達20、及連結於兩台上下驅動用馬達20之各個的兩個減速機21。如圖4所示,一台上下驅動用馬達20、兩個減速機21及一台上下驅動用馬達20從上方起依此順序而固定於支持構件7上。As shown in Fig. 5, the vertical drive mechanism 16 is disposed on the side of the columnar member 8 (below the columnar member 8 of Fig. 5). The vertical drive mechanism 16 includes two upper and lower drive motors 20 and two reducers 21 connected to each of the two vertical drive motors 20. As shown in Fig. 4, one vertical drive motor 20, two reduction gears 21, and one vertical drive motor 20 are fixed to the support member 7 in this order from the top.
另外,上下驅動機構16包括:固定於兩個減速機21之各輸出軸上之作為上下驅動用小齒輪的兩個小齒輪(pinion)22;及與兩個小齒輪22嚙合之作為上下驅動用齒條的齒條23。藉由該兩個小齒輪22與齒條23,支持構件7會於上下方向移動。進而,上下驅動機構16包括用以使上下驅動機構16停止(即,用以使支持構件7停止)之兩個上下制動機構24。Further, the vertical drive mechanism 16 includes two pinions 22 that are fixed to the output shafts of the two reduction gears 21 as upper and lower drive pinions, and two pinions 22 that mesh with the two pinions 22 for up and down drive. Rack 23 of the rack. With the two pinion gears 22 and the rack 23, the support member 7 moves in the up and down direction. Further, the upper and lower drive mechanism 16 includes two upper and lower brake mechanisms 24 for stopping the upper and lower drive mechanisms 16 (i.e., for stopping the support member 7).
另外,如圖5所示,機器人1包括用以於上下方向導引支持構件7之導引部25。導引部25係由導軌26及卡合於導軌26之導引塊27所構成。再者,柱狀構件8形成為以上下方向作為長度方向之細長的大致角柱狀,支持構件7形成為塊狀。Further, as shown in FIG. 5, the robot 1 includes a guide portion 25 for guiding the support member 7 in the up and down direction. The guide portion 25 is composed of a guide rail 26 and a guide block 27 that is engaged with the guide rail 26. Further, the columnar member 8 is formed in a substantially angular columnar shape in which the upper and lower directions are elongated in the longitudinal direction, and the support member 7 is formed in a block shape.
上下驅動用馬達20包括用以檢測上下驅動用馬達20之旋轉速度之速度檢測機構(省略圖示)。該速度檢測機構例如係由形成為圓板狀之狹縫板、及以夾隔有狹縫板之狀態而對向配置的發光元件與受光元件所構成。The vertical drive motor 20 includes a speed detecting mechanism (not shown) for detecting the rotational speed of the vertical drive motor 20. The speed detecting means is composed of, for example, a slit plate formed in a disk shape and a light-emitting element and a light-receiving element which are disposed to face each other with the slit plate interposed therebetween.
如圖6所示,於上下驅動用馬達20之輸出軸上,固定有滑輪28。另外,於減速機21之輸入軸上,固定有比滑輪28之直徑大的滑輪29。於滑輪28、29上,架設有皮帶30,於上下方向上相鄰配置之上下驅動用馬達20及減速機21係藉由該皮帶30而連結。As shown in FIG. 6, the pulley 28 is fixed to the output shaft of the up-and-down drive motor 20. Further, a pulley 29 larger than the diameter of the pulley 28 is fixed to the input shaft of the speed reducer 21. A belt 30 is placed on the pulleys 28 and 29, and the upper and lower driving motors 20 and the speed reducer 21 are connected adjacent to each other in the vertical direction by the belt 30.
齒條23係以上下方向作為長度方向而固定於柱狀構件8上(參照圖5)。如上所述,本實施形態中,支持構件7之上下方向之行程較長。即,齒條23之長度較長。因此,本實施形態中,齒條23係藉由將複數個齒條片接在一起而形成。另外,一個齒條片之長度變得比兩個小齒輪22之配置間距長。The rack 23 is fixed to the columnar member 8 as a longitudinal direction in the up-down direction (see FIG. 5). As described above, in the present embodiment, the stroke of the support member 7 in the vertical direction is long. That is, the length of the rack 23 is long. Therefore, in the present embodiment, the rack 23 is formed by joining a plurality of rack pieces together. In addition, the length of one rack piece becomes longer than the arrangement pitch of the two pinion gears 22.
如圖6等所示,上下制動機構24係以與滑輪29相鄰之方式安裝於減速機21之輸入軸上。即,兩個上下制動機構24之各個經由滑輪28、29及皮帶30而連結於兩台上下驅動用馬達20之各個。As shown in FIG. 6 and the like, the upper and lower brake mechanisms 24 are attached to the input shaft of the reduction gear 21 so as to be adjacent to the pulley 29. That is, each of the two upper and lower brake mechanisms 24 is coupled to each of the two vertical drive motors 20 via the pulleys 28 and 29 and the belt 30.
該上下制動機構24係所謂的無勵磁作動型之制動器,其包括:收納有線圈之殼體;固定於殼體上之側板;相對於殼體而於軸方向可移動地配置之電樞;配置於側板與電樞之間並固定於減速機21之輸入軸上之制動盤;以及對電樞朝向制動盤施力之壓縮螺旋彈簧。上下制動機構24中,在線圈成為通電狀態時,電樞被殼體所吸引,制動盤得以釋放。另外,在停止對線圈通電時,藉由壓縮螺旋彈簧之施力而將制動盤夾在電樞與側板之間,對減速機21進行緊急制動。再者,一個上下制動機構24具有可使包括基板2、機械手3、臂4及支持構件7等在內的於上下方向移動之部分充分停止之制動力。The upper and lower brake mechanism 24 is a so-called non-excitation type brake, and includes: a housing that houses the coil; a side plate that is fixed to the housing; and an armature that is movably disposed in the axial direction with respect to the housing; a brake disc disposed between the side plate and the armature and fixed to the input shaft of the reducer 21; and a compression coil spring biasing the armature toward the brake disc. In the upper and lower brake mechanism 24, when the coil is energized, the armature is attracted by the casing, and the brake disc is released. Further, when the energization of the coil is stopped, the brake disc is sandwiched between the armature and the side plate by the biasing force of the compression coil spring, and the speed reducer 21 is braked urgently. Further, the upper and lower brake mechanisms 24 have a braking force that can sufficiently stop the portion that moves in the vertical direction including the substrate 2, the robot 3, the arm 4, and the support member 7.
導軌26係以上下方向為長度方向而固定於柱狀構件8上(參照圖5)。本實施形態中,兩條導軌26固定於柱狀構件8上。具體而言,於圖5之左右方向上平行之兩個柱狀構件8之安裝面的各個上固定有導軌26。另外,配置於圖5下側之導軌26係以與齒條23相鄰之方式而被固定。The guide rail 26 is fixed to the columnar member 8 in the longitudinal direction of the upper and lower directions (see FIG. 5). In the present embodiment, the two guide rails 26 are fixed to the columnar member 8. Specifically, the guide rails 26 are fixed to the mounting faces of the two columnar members 8 which are parallel in the left-right direction of FIG. Further, the guide rail 26 disposed on the lower side of FIG. 5 is fixed adjacent to the rack 23.
導引塊27固定於支持構件7上。具體而言,於支持構件7之與臂4之固定面(圖5之右端面)正交之面上,固定有導引塊27,導引塊27從圖5之上下方向之外側卡合於導軌26。The guide block 27 is fixed to the support member 7. Specifically, on the surface of the support member 7 that is orthogonal to the fixed surface of the arm 4 (the right end surface of FIG. 5), a guide block 27 is fixed, and the guide block 27 is engaged from the outer side of the upper and lower sides of FIG. Guide rail 26.
再者,本實施形態中,如圖5所示,於柱狀構件8上固定有蓋構件31。該蓋構件31係以從圖5之上下覆蓋導軌26之方式而配置。Further, in the present embodiment, as shown in FIG. 5, the lid member 31 is fixed to the columnar member 8. The cover member 31 is disposed to cover the guide rail 26 from above and below in FIG.
(水平驅動機構及其周邊部之構成)(Composition of horizontal drive mechanism and its peripheral parts)
圖7係用以說明圖2之J部之內部構成的示圖。圖8係用以從圖3之K-K方向來說明水平驅動機構17等之構成的示圖。圖9係用以從圖8之L-L方向來說明水平驅動機構17之構成的示圖。Fig. 7 is a view for explaining the internal configuration of the J portion of Fig. 2. Fig. 8 is a view for explaining the configuration of the horizontal drive mechanism 17 and the like from the K-K direction of Fig. 3. Fig. 9 is a view for explaining the configuration of the horizontal drive mechanism 17 from the L-L direction of Fig. 8.
如圖7所示,水平驅動機構17配置於圖7之基台9之左端側。該水平驅動機構17包括兩台水平驅動用馬達40。如圖8所示,兩台水平驅動用馬達40係以於圖8之左右方向上相鄰之方式而配置。另外,兩台水平驅動用馬達40之各個固定於基台9上所固定之兩個支架52之各個上。在兩個支架52之各個上,如圖8、圖9所示,經由軸承54而可旋轉地保持有轉軸53。兩根轉軸53係以於圖8之左右方向上相鄰之方式而配置。As shown in Fig. 7, the horizontal drive mechanism 17 is disposed on the left end side of the base 9 of Fig. 7. The horizontal drive mechanism 17 includes two horizontal drive motors 40. As shown in Fig. 8, the two horizontal drive motors 40 are arranged adjacent to each other in the left-right direction of Fig. 8. Further, each of the two horizontal drive motors 40 is fixed to each of the two brackets 52 fixed to the base 9. On each of the two brackets 52, as shown in Figs. 8 and 9, the rotating shaft 53 is rotatably held via a bearing 54. The two rotating shafts 53 are arranged adjacent to each other in the left-right direction of FIG.
又,水平驅動機構17包括:固定於兩根轉軸53各自之下端之作為水平驅動用小齒輪的兩個小齒輪42;及與兩個小齒輪42嚙合之作為水平驅動用齒條的齒條43。藉由該兩個小齒輪42及齒條43,基台9會朝水平方向移動。進而,水平驅動機構17包括用以使水平驅動機構17停止(即,用以使基台9停止)之兩個水平制動機構44。Further, the horizontal drive mechanism 17 includes two pinion gears 42 as horizontal drive pinions fixed to the lower ends of the two rotary shafts 53, and a rack 43 as a horizontal drive rack that meshes with the two pinion gears 42. . With the two pinion gears 42 and the rack 43, the base 9 is moved in the horizontal direction. Further, the horizontal drive mechanism 17 includes two horizontal brake mechanisms 44 for stopping the horizontal drive mechanism 17 (i.e., to stop the base 9).
另外,機器人1包括用以於水平方向導引基台9之導引部45。導引部45係由導軌46及卡合於導軌46之導引塊47所構成。又,如圖7、圖8所示,基座構件6包括細長的兩條軌道狀構件51。該軌道狀構件51係以於圖7之左右方向上空開特定間隔之狀態而平行地配置。Further, the robot 1 includes a guide portion 45 for guiding the base 9 in the horizontal direction. The guide portion 45 is composed of a guide rail 46 and a guide block 47 that is engaged with the guide rail 46. Further, as shown in FIGS. 7 and 8, the base member 6 includes two elongated rail-shaped members 51. The rail-shaped members 51 are arranged in parallel in a state in which a certain interval is left in the left-right direction of FIG.
水平驅動用馬達40包括用以檢測水平驅動用馬達40之旋轉速度之速度檢測機構(省略圖示)。該速度檢測機構例如係由形成為圓板狀之狹縫板、及以夾隔有狹縫板之狀態而對向配置的發光元件及受光元件所構成。The horizontal drive motor 40 includes a speed detecting mechanism (not shown) for detecting the rotational speed of the horizontal drive motor 40. The speed detecting means is composed of, for example, a slit plate formed in a disk shape and a light-emitting element and a light-receiving element which are disposed to face each other with the slit plate interposed therebetween.
如圖9所示,於水平驅動用馬達40之輸出軸上,固定有滑輪48。又,於轉軸53之上端側,固定有比滑輪48之直徑大的滑輪49。於滑輪48、49上,架設有皮帶50,於圖8之上下方向上相鄰配置之水平驅動用馬達40及轉軸53係藉由該皮帶50而連結。As shown in FIG. 9, a pulley 48 is fixed to the output shaft of the horizontal drive motor 40. Further, a pulley 49 larger than the diameter of the pulley 48 is fixed to the upper end side of the rotating shaft 53. A belt 50 is placed on the pulleys 48 and 49, and the horizontal drive motor 40 and the rotary shaft 53 which are disposed adjacent to each other in the lower direction of FIG. 8 are coupled by the belt 50.
如圖8所示,齒條43固定於軌道狀構件51之上面。本實施形態中,由於基台9之移動量較大,故齒條43之長度較長。因此,齒條43係藉由將複數個齒條片接在一起而形成。As shown in FIG. 8, the rack 43 is fixed to the upper surface of the rail-shaped member 51. In the present embodiment, since the amount of movement of the base 9 is large, the length of the rack 43 is long. Therefore, the rack 43 is formed by joining a plurality of rack pieces together.
如圖9所示,水平制動機構44以與滑輪48相鄰之方式安裝於水平驅動用馬達40之輸出軸上。該水平制動機構44係與上下制動機構24同樣的所謂無勵磁作動型之制動器,並與上下制動機構24同樣地構成。即,水平制動機構44中,在線圈成為通電狀態時,電樞被殼體所吸引,制動盤得以釋放。另外,在停止對線圈通電時,藉由壓縮螺旋彈簧之施力而將制動盤夾在電樞與側板之間,對水平驅動用馬達40進行緊急制動。As shown in FIG. 9, the horizontal brake mechanism 44 is attached to the output shaft of the horizontal drive motor 40 so as to be adjacent to the pulley 48. The horizontal brake mechanism 44 is a so-called non-excitation type brake similar to the vertical brake mechanism 24, and is configured similarly to the upper and lower brake mechanisms 24. That is, in the horizontal brake mechanism 44, when the coil is in the energized state, the armature is attracted by the casing, and the brake disc is released. Further, when the energization of the coil is stopped, the brake disc is sandwiched between the armature and the side plate by the biasing force of the compression coil spring, and the horizontal drive motor 40 is braked urgently.
如圖8所示,導軌46固定於軌道狀構件51之上面。本實施形態中,於兩條軌道狀構件51各自之上面固定有導軌46。另外,配置於圖8上側之導軌46係以與齒條43相鄰之方式而被固定。如圖7所示,導引塊47固定於圖7之左右方向之基台9的兩端部。該導引塊47從上側卡合於導軌46。As shown in FIG. 8, the guide rail 46 is fixed to the upper surface of the rail-shaped member 51. In the present embodiment, the guide rails 46 are fixed to the upper surfaces of the two rail-shaped members 51. Further, the guide rail 46 disposed on the upper side of FIG. 8 is fixed adjacent to the rack 43. As shown in Fig. 7, the guide blocks 47 are fixed to both end portions of the base 9 in the left-right direction of Fig. 7. The guide block 47 is engaged with the guide rail 46 from the upper side.
(旋轉驅動機構及其周邊部分之構成)(Configuration of the rotary drive mechanism and its peripheral parts)
圖10係圖1所示之回旋構件10之俯視圖。圖11係圖10之M-M剖面之剖面圖。Figure 10 is a plan view of the swing member 10 shown in Figure 1. Figure 11 is a cross-sectional view of the M-M section of Figure 10.
如圖10、圖11所示,旋轉驅動機構18配置於作為回旋構件10之回旋中心之中心軸CL的四周。該旋轉驅動機構18包括兩台旋轉驅動用馬達60。如圖10所示,兩台旋轉驅動用馬達60相對於中心軸CL而點對稱地配置,並固定於回旋構件10之中心部。另外,旋轉驅動機構18包括固定於回旋構件10之中心部的減速機61。進而,旋轉驅動機構18包括用以使旋轉驅動機構18停止(即,用以使回旋構件10停止)之一個旋轉制動機構64。再者,回旋構件10為細長之塊狀構件,在其一端側(圖10之左端側)固定有柱狀構件8之下端。As shown in FIGS. 10 and 11, the rotation drive mechanism 18 is disposed around the center axis CL which is the center of the swirl of the swing member 10. The rotary drive mechanism 18 includes two rotary drive motors 60. As shown in FIG. 10, the two rotation drive motors 60 are arranged in point symmetry with respect to the center axis CL, and are fixed to the center portion of the gyroscopic member 10. Further, the rotation drive mechanism 18 includes a reduction gear 61 that is fixed to a central portion of the revolving member 10. Further, the rotary drive mechanism 18 includes a rotary brake mechanism 64 for stopping the rotary drive mechanism 18 (i.e., to stop the swing member 10). Further, the revolving member 10 is an elongated block-shaped member, and the lower end of the columnar member 8 is fixed to one end side (the left end side of FIG. 10).
旋轉驅動用馬達60包括用以檢測旋轉驅動用馬達60之旋轉速度之速度檢測機構(省略圖示)。該速度檢測機構例如係由形成為圓板狀之狹縫板、及以夾隔有狹縫板之狀態而對向配置的發光元件與受光元件所構成。The rotation drive motor 60 includes a speed detecting mechanism (not shown) for detecting the rotation speed of the rotation drive motor 60. The speed detecting means is composed of, for example, a slit plate formed in a disk shape and a light-emitting element and a light-receiving element which are disposed to face each other with the slit plate interposed therebetween.
如圖11所示,在旋轉驅動用馬達60之輸出軸上,固定有輸出齒輪68,兩個輸出齒輪68與減速機61之輸入齒輪69嚙合。藉由該兩個輸出齒輪68及包括輸入齒輪69之減速機61,回旋構件10會相對於基台9而回旋。即,在回旋構件10之中心部固定有減速機61之輸出側,在經由減速機61所傳遞之旋轉驅動用馬達60之動力之作用下,回旋構件10會相對於基台9而旋轉。As shown in FIG. 11, an output gear 68 is fixed to the output shaft of the rotary drive motor 60, and the two output gears 68 mesh with the input gear 69 of the speed reducer 61. The revolving member 10 is rotated relative to the base 9 by the two output gears 68 and the speed reducer 61 including the input gear 69. That is, the output side of the speed reducer 61 is fixed to the center portion of the turning member 10, and the turning member 10 rotates with respect to the base 9 by the power of the rotation driving motor 60 transmitted through the speed reducer 61.
如圖11所示,旋轉制動機構64固定於轉軸73之上端,該轉軸73係經由軸承74而可旋轉地保持於回旋構件10之中心部。於轉軸73之下端,固定有與減速機61之輸入齒輪69嚙合之齒輪70。又,如圖10所示,旋轉制動機構64配置於以中心軸CL為中心而使旋轉驅動用馬達60旋轉90°之位置上。As shown in FIG. 11, the rotary brake mechanism 64 is fixed to the upper end of the rotary shaft 73, and the rotary shaft 73 is rotatably held by the center portion of the rotary member 10 via a bearing 74. At the lower end of the rotating shaft 73, a gear 70 that meshes with the input gear 69 of the speed reducer 61 is fixed. Further, as shown in FIG. 10, the rotary brake mechanism 64 is disposed at a position where the rotary drive motor 60 is rotated by 90° around the central axis CL.
該旋轉制動機構64係與上下制動機構24同樣的所謂無勵磁作動型之制動器,並與上下制動機構24同樣地構成。即,旋轉制動機構64中,在線圈成為通電狀態時,電樞被殼體所吸引,制動盤得以釋放。另外,在停止對線圈通電時,藉由壓縮螺旋彈簧之施力而將制動盤夾在電樞與側板之間,對輸入齒輪69進行緊急制動。The rotary brake mechanism 64 is a so-called non-excitation type brake similar to the vertical brake mechanism 24, and is configured similarly to the upper and lower brake mechanisms 24. That is, in the rotary brake mechanism 64, when the coil is in the energized state, the armature is attracted by the casing, and the brake disc is released. Further, when the energization of the coil is stopped, the brake disc is sandwiched between the armature and the side plate by the biasing force of the compression coil spring, and the input gear 69 is urgently braked.
(控制部之構成)(Composition of Control Department)
圖12係圖1所示之產業用機器人1之控制部80及其相關部分之方框圖。再者,圖12中,圖示有與上下驅動機構16、水平驅動機構17及旋轉驅動機構18之控制相關之控制部80的構成。Fig. 12 is a block diagram showing the control unit 80 of the industrial robot 1 shown in Fig. 1 and its related parts. In addition, in FIG. 12, the structure of the control part 80 related to the control of the up-and-down drive mechanism 16, the horizontal drive mechanism 17, and the rotation drive mechanism 18 is shown.
如圖12所示,作為與上下驅動機構16、水平驅動機構17及旋轉驅動機構18之控制相關之構成,控制部80包括:控制兩台上下驅動用馬達20之上下馬達控制部81;控制兩台水平驅動用馬達40之水平馬達控制部82;控制兩台旋轉驅動用馬達60之旋轉馬達控制部83;控制兩個上下制動機構24之上下制動器控制部84;控制兩個水平制動機構44之水平制動器控制部85;以及控制一個旋轉制動機構64之旋轉制動器控制部86。又,在控制部80上,連接有控制指令部87。As shown in FIG. 12, as a configuration related to the control of the vertical drive mechanism 16, the horizontal drive mechanism 17, and the rotary drive mechanism 18, the control unit 80 includes two upper and lower drive motors 20 for controlling the upper and lower motor control portions 81; a horizontal motor control unit 82 for the horizontal drive motor 40; a rotary motor control unit 83 for controlling the two rotary drive motors 60; two upper and lower brake mechanisms 24 for controlling the upper and lower brake control units 84; and two horizontal brake mechanisms 44 for controlling The horizontal brake control unit 85; and a rotary brake control unit 86 that controls one rotary brake mechanism 64. Further, a control command unit 87 is connected to the control unit 80.
上下馬達控制部81各別控制兩台上下驅動用馬達20之各個。具體而言,上下馬達控制部81藉由速度控制與轉矩控制來控制兩台上下驅動用馬達20中之一方之上下驅動用馬達20,並藉由轉矩控制來控制另一方之上下驅動用馬達20。即,上下馬達控制部81針對一方之上下驅動用馬達20,進行基於來自該上下驅動用馬達20之速度檢測機構之輸出的反饋控制及控制該上下驅動用馬達20之電流值的轉矩控制,且針對另一方之上下驅動用馬達20,並不進行基於來自該上下驅動用馬達20之速度檢測機構之輸出的反饋控制,而進行控制該上下驅動用馬達20之電流值的轉矩控制。The upper and lower motor control units 81 individually control each of the two upper and lower drive motors 20. Specifically, the upper and lower motor control unit 81 controls one of the two upper and lower driving motors 20 by the speed control and the torque control, and controls the other upper and lower driving by the torque control. Motor 20. In other words, the upper and lower motor control unit 81 performs feedback control based on the output of the speed detecting means from the vertical driving motor 20 and torque control for controlling the current value of the vertical driving motor 20 for one of the upper and lower driving motors 20, Further, the drive motor 20 for the upper and lower driving is not subjected to feedback control based on the output of the speed detecting means from the vertical driving motor 20, and torque control for controlling the current value of the vertical driving motor 20 is performed.
本實施形態中,兩台上下驅動用馬達20中之一方之上下驅動用馬達20為第一驅動用馬達。又,另一方之上下驅動用馬達20為第二驅動用馬達。In the present embodiment, one of the two upper and lower drive motors 20 is the first drive motor. Further, the other upper and lower driving motor 20 is a second driving motor.
水平馬達控制部82各別控制兩台水平驅動用馬達40之各個。具體而言,水平馬達控制部82藉由速度控制與轉矩控制來控制兩台水平驅動用馬達40中之一方之水平驅動用馬達40。另外,水平馬達控制部82在另一方之水平驅動用馬達40停止前,與一方之水平驅動用馬達40同樣地,藉由速度控制與轉矩控制來控制另一方之水平驅動用馬達40,但在除另一方之水平驅動用馬達40停止前之其他情況時,則藉由轉矩控制來控制另一方之水平驅動用馬達40。The horizontal motor control unit 82 controls each of the two horizontal drive motors 40 individually. Specifically, the horizontal motor control unit 82 controls one of the two horizontal drive motors 40 by the speed control and the torque control. In addition, the horizontal motor control unit 82 controls the other horizontal drive motor 40 by speed control and torque control, similarly to one of the horizontal drive motors 40, before the other horizontal drive motor 40 is stopped. When the other horizontal driving motor 40 is stopped before the other, the other horizontal driving motor 40 is controlled by the torque control.
即,在除另一方之水平驅動用馬達40停止前之其他情況時,水平馬達控制部82針對另一方之水平驅動用馬達40,並不進行基於來自該水平驅動用馬達40之速度檢測機構之輸出的反饋控制,而進行轉矩控制。另外,在另一方之水平驅動用馬達40停止前,水平馬達控制部82針對另一方之水平驅動用馬達40,進行基於來自該水平驅動用馬達40之速度檢測機構之輸出的反饋控制,對另一方之水平驅動用馬達40之旋轉速度進行控制,以使兩個小齒輪42與齒條43之間的齒隙消失。In other words, the horizontal motor control unit 82 does not perform the speed detecting mechanism based on the horizontal driving motor 40 for the other horizontal driving motor 40 except when the other horizontal driving motor 40 is stopped. Output feedback control for torque control. Further, before the other horizontal drive motor 40 is stopped, the horizontal motor control unit 82 performs feedback control based on the output of the speed detecting mechanism from the horizontal drive motor 40 for the other horizontal drive motor 40, and The rotational speed of the horizontal drive motor 40 is controlled such that the backlash between the two pinion gears 42 and the rack 43 disappears.
此處,另一方之水平驅動用馬達40是否為停止前之狀態,例如係由水平馬達控制部82根據來自一方之水平驅動用馬達40之速度檢測機構之輸出而判斷。例如,水平馬達控制部82計算由一方之水平驅動用馬達40之速度檢測機構所檢測出的基台9之從特定之基準位置至停止預定位置為止的脈衝數、與由速度檢測機構實際所檢測出的脈衝數之差,當該差為特定之值以下時,則判斷為另一方之水平驅動用馬達40為停止前之狀態。即,在基台9進入到從停止預定位置起算之特定距離之範圍內時,另一方之水平驅動用馬達40成为停止前之狀態。Here, whether or not the other horizontal drive motor 40 is in a state before the stop is determined, for example, by the horizontal motor control unit 82 based on the output of the speed detecting means from the one horizontal drive motor 40. For example, the horizontal motor control unit 82 calculates the number of pulses from the specific reference position to the predetermined stop position of the base 9 detected by the speed detecting means of the one horizontal drive motor 40, and is actually detected by the speed detecting means. When the difference between the number of pulses and the difference is a specific value or less, it is determined that the other horizontal drive motor 40 is in a state before the stop. That is, when the base 9 enters the range of a specific distance from the stop planned position, the other horizontal drive motor 40 is in a state before the stop.
本實施形態中,兩台水平驅動用馬達40中之一方之水平驅動用馬達40為第一驅動用馬達,且為第一水平驅動用馬達。又,另一方之水平驅動用馬達40為第二驅動用馬達,且為第二水平驅動用馬達。In the present embodiment, one of the two horizontal drive motors 40 is the first drive motor and the first horizontal drive motor. Further, the other horizontal drive motor 40 is a second drive motor and is a second horizontal drive motor.
同樣地,旋轉馬達控制部83各別控制兩台旋轉驅動用馬達60之各個。具體而言,旋轉馬達控制部83藉由速度控制與轉矩控制來控制兩台旋轉驅動用馬達60中之一方之旋轉驅動用馬達60。另外,旋轉馬達控制部83在另一方之旋轉驅動用馬達60停止前,與一方之旋轉驅動用馬達60同樣地,藉由速度控制與轉矩控制來控制另一方之旋轉驅動用馬達60,但在除另一方之旋轉驅動用馬達60停止前之其他情況時,則藉由轉矩控制來控制另一方之旋轉驅動用馬達60。Similarly, the rotation motor control unit 83 controls each of the two rotation drive motors 60 individually. Specifically, the rotation motor control unit 83 controls one of the two rotation drive motors 60 by the speed control and the torque control. In addition, the rotation motor control unit 83 controls the other rotation drive motor 60 by speed control and torque control, similarly to one of the rotation drive motors 60, before the other rotation drive motor 60 is stopped. When the other of the rotation drive motors 60 is stopped, the other rotation drive motor 60 is controlled by the torque control.
即,在除另一方之旋轉驅動用馬達60停止前之其他情況時,旋轉馬達控制部83針對另一方之旋轉驅動用馬達60,不進行基於來自該旋轉驅動用馬達60之速度檢測機構之輸出的反饋控制,而進行轉矩控制。另外,在另一方之旋轉驅動用馬達60停止前,旋轉馬達控制部83針對另一方之旋轉驅動用馬達60,進行基於來自該旋轉驅動用馬達60之速度檢測機構之輸出的反饋控制,對另一方之旋轉驅動用馬達60之旋轉速度進行控制,以使兩個輸出齒輪68與輸入齒輪69之間的齒隙消失。In other words, when the other rotation drive motor 60 is stopped, the rotation motor control unit 83 does not perform the output based on the speed detection mechanism from the rotation drive motor 60 with respect to the other rotation drive motor 60. Feedback control while performing torque control. Further, before the other rotation drive motor 60 is stopped, the rotation motor control unit 83 performs feedback control based on the output of the speed detection mechanism from the rotation drive motor 60 for the other rotation drive motor 60, and The rotational speed of one of the rotational drive motors 60 is controlled such that the backlash between the two output gears 68 and the input gear 69 disappears.
此處,另一方之旋轉驅動用馬達60是否為停止前之狀態,例如係由旋轉馬達控制部83根據來自一方之旋轉驅動用馬達60之速度檢測機構之輸出而判斷。例如,旋轉馬達控制部83計算由一方之旋轉驅動用馬達60之速度檢測機構所檢測出的回旋構件10之從特定之基準位置至停止預定位置為止的脈衝數、與由速度檢測機構實際所檢測出的脈衝數之差,當該差為特定之值以下時,則判斷為另一方之旋轉驅動用馬達60為停止前之狀態。即,在回旋構件10進入到從停止預定位置起算之特定角度範圍內時,另一方旋轉驅動用馬達60成為停止前之狀態。Here, whether or not the other rotation drive motor 60 is in a state before the stop is determined by, for example, the rotation motor control unit 83 based on the output of the speed detection mechanism from one of the rotation drive motors 60. For example, the rotation motor control unit 83 calculates the number of pulses from the specific reference position to the predetermined stop position of the swing member 10 detected by the speed detecting means of one of the rotational drive motors 60, and is actually detected by the speed detecting means. When the difference between the number of pulses and the difference is a specific value or less, it is determined that the other rotation drive motor 60 is in a state before the stop. That is, when the turning member 10 enters the specific angle range from the stop planned position, the other rotational driving motor 60 is in a state before the stop.
本實施形態中,兩台旋轉驅動用馬達60中之一方之旋轉驅動用馬達60為第一驅動用馬達,且為第一旋轉驅動用馬達。又,另一方之旋轉驅動用馬達60為第二驅動用馬達,且為第二旋轉驅動用馬達。In the present embodiment, one of the two rotation drive motors 60 is the first drive motor and the first rotation drive motor. Further, the other rotation drive motor 60 is a second drive motor and is a second rotation drive motor.
上下制動器控制部84在從控制指令部87輸入有支持構件7之停止信號時,會使兩個上下制動機構24階段性地作動。即,在從控制指令部87輸入有支持構件7之停止信號時,上下制動器控制部84會以一方之上下制動機構24之作動開始時刻與另一方之上下制動機構24之作動開始時刻不同(錯開)的方式,使兩個上下制動機構24作動。具體而言,上下制動器控制部84會以另一方之上下制動機構24之作動開始時刻遲於一方之上下制動機構24之作動開始時刻的方式,使兩個上下制動機構24作動。更具體而言,上下制動器控制部84以對另一方之上下制動機構24之線圈停止通電之時刻遲於對一方之上下制動機構24之線圈停止通電之時刻的方式,停止對兩個上下制動機構24之線圈之通電。When the stop signal of the support member 7 is input from the control command unit 87, the vertical brake control unit 84 causes the two vertical brake mechanisms 24 to be operated stepwise. In other words, when the stop signal of the support member 7 is input from the control command unit 87, the upper and lower brake control unit 84 sets the start timing of the one upper and lower brake mechanisms 24 to be different from the start timing of the other upper and lower brake mechanisms 24 (staggered) The way, the two upper and lower brake mechanisms 24 are actuated. Specifically, the upper and lower brake control unit 84 activates the two vertical brake mechanisms 24 such that the actuation start timing of the other upper and lower brake mechanisms 24 is later than the actuation start timing of one of the upper and lower brake mechanisms 24 . More specifically, the upper and lower brake control unit 84 stops the two upper and lower brake mechanisms so that the timing of stopping the energization of the coil of the other upper and lower brake mechanism 24 is later than the timing of stopping the energization of the coil of the upper and lower brake mechanism 24 The coil of 24 is energized.
同樣地,水平制動器控制部85在從控制指令部87輸入有基台9之停止信號時,會使兩個水平制動機構44階段性地作動。即,在從控制指令部87輸入有基台9之停止信號時,水平制動器控制部85會以一方之水平制動機構44之作動開始時刻與另一方之水平制動機構44之作動開始時刻錯開的方式,使兩個水平制動機構44作動。具體而言,水平制動器控制部85會以另一方之水平制動機構44之作動開始時刻遲於一方之水平制動機構44之作動開始時刻的方式,使兩個水平制動機構44作動。再者,在從控制指令部87輸入有基台9之停止信號時,水平制動器控制部85亦可使兩個水平制動機構44同時作動。Similarly, when the horizontal brake control unit 85 receives the stop signal of the base 9 from the control command unit 87, the two horizontal brake mechanisms 44 are operated stepwise. In other words, when the stop signal of the base 9 is input from the control command unit 87, the horizontal brake control unit 85 shifts the start timing of the one horizontal brake mechanism 44 from the start timing of the other horizontal brake mechanism 44. The two horizontal brake mechanisms 44 are actuated. Specifically, the horizontal brake control unit 85 activates the two horizontal brake mechanisms 44 such that the actuation start timing of the other horizontal brake mechanism 44 is later than the actuation start timing of one of the horizontal brake mechanisms 44. Further, when the stop signal of the base 9 is input from the control command unit 87, the horizontal brake control unit 85 can also simultaneously actuate the two horizontal brake mechanisms 44.
(本實施形態之主要效果)(Main effects of this embodiment)
如以上所說明,本實施形態中,上下驅動機構16包括兩台上下驅動用馬達20。因此,為了搬送大型的基板2,即便在上下驅動機構16所要求之上下驅動用馬達20之總容量變大的情況下,亦可使用外形相對較小的上下驅動用馬達20。例如,在上下驅動機構16所要求之上下驅動用馬達20之總容量為10kW時,可使用外形相對較小的5kW之上下驅動用馬達20,而不使用外形較大的10kW之上下驅動用馬達。另外,與使用外形較大的一台上下驅動用馬達之情形相比,在使用外形較小的兩台上下驅動用馬達20時,上下驅動用馬達20之配置之自由度變高。因此,本實施形態中,儘管搬送較大的基板2,亦能實現機器人1之小型化。As described above, in the present embodiment, the vertical drive mechanism 16 includes two upper and lower drive motors 20. Therefore, in order to convey the large-sized substrate 2, even when the total capacity of the upper-lower drive motor 20 is increased as required by the vertical drive mechanism 16, the upper-lower drive motor 20 having a relatively small outer shape can be used. For example, when the total capacity of the upper and lower drive motors 20 required by the upper and lower drive mechanisms 16 is 10 kW, a 5 kW upper and lower drive motor 20 having a relatively small outer shape can be used instead of a 10 kW upper and lower drive motor having a large outer shape. . Further, when two up-and-down driving motors 20 having a small outer shape are used, the degree of freedom in disposing the upper and lower driving motors 20 is higher than in the case of using one of the upper and lower driving motors having a large outer shape. Therefore, in the present embodiment, the size of the robot 1 can be reduced even if the large substrate 2 is transported.
另外,在上下驅動用馬達20之容量超過特定之容量時,上下驅動用馬達20之價格會急遽升高,但本實施形態中,由於可使用容量相對較小的上下驅動用馬達20,故即便在使用兩台上下驅動用馬達20之情況下,亦能降低機器人1之成本。In addition, when the capacity of the up-and-down driving motor 20 exceeds a specific capacity, the price of the up-and-down driving motor 20 is rapidly increased. However, in the present embodiment, since the up-and-down driving motor 20 having a relatively small capacity can be used, even When the two upper and lower drive motors 20 are used, the cost of the robot 1 can also be reduced.
進而,本實施形態中,由於可使用容量相對較小的上下驅動用馬達20,故從一台上下驅動用馬達20所傳遞之動力變小。因此,可減小對傳遞上下驅動用馬達20之動力之減速機21、小齒輪22及齒條23等動力傳遞機構的傳遞動力,從而可簡化減速機21、小齒輪22及齒條23等動力傳遞機構之構成。而且,可抑制減速機2、小齒輪22及齒條23等的動力傳遞機構之損傷。Further, in the present embodiment, since the up-and-down driving motor 20 having a relatively small capacity can be used, the power transmitted from one of the vertical driving motors 20 is reduced. Therefore, the transmission power to the power transmission mechanism such as the speed reducer 21, the pinion gear 22, and the rack 23 that transmits the power of the upper and lower drive motors 20 can be reduced, and the powers of the reduction gear 21, the pinion 22, and the rack 23 can be simplified. The composition of the delivery mechanism. Further, damage to the power transmission mechanism such as the reduction gear 2, the pinion 22, and the rack 23 can be suppressed.
另一方面,由於上下驅動機構16使用兩台上下驅動用馬達20,故有產生如下情況之虞:一方之上下驅動用馬達20之驅動轉矩成為另一方之上下驅動用馬達20之較大的負載,且另一方之上下驅動用馬達20之驅動轉矩成為一方之上下驅動用馬達20之較大的負載,但本實施形態中,上下馬達控制部81係藉由速度控制與轉矩控制來控制兩台上下驅動用馬達20中之一方之上下驅動用馬達20,並藉由轉矩控制來控制另一方之上下驅動用馬達20。即,上下馬達控制部81控制一方之上下驅動用馬達20之旋轉速度,但不控制另一方之上下驅動用馬達20之旋轉速度,另一方之上下驅動用馬達20係隨從一方之上下驅動用馬達20而旋轉。因此,不會在兩台上下驅動用馬達20之間產生較大的旋轉速度之差。故而,可防止一方之上下驅動用馬達20之驅動轉矩成為另一方之上下驅動用馬達20之較大的負載,且可防止另一方之上下驅動用馬達20之驅動轉矩成為一方之上下驅動用馬達20之較大的負載。On the other hand, since the up-and-down drive mechanism 16 uses the two up-and-down drive motors 20, there is a case where the drive torque of one of the upper and lower drive motors 20 is larger than that of the other upper and lower drive motors 20. The load and the driving torque of the upper and lower driving motor 20 become a large load of the one upper and lower driving motor 20, but in the present embodiment, the upper and lower motor control unit 81 is controlled by the speed control and the torque control. One of the two upper and lower drive motors 20 is controlled to drive the upper and lower drive motors 20, and the other upper and lower drive motors 20 are controlled by torque control. In other words, the upper and lower motor control unit 81 controls the rotational speed of one of the upper and lower drive motors 20, but does not control the rotational speed of the other upper and lower drive motors 20, and the other upper and lower drive motors 20 follow the upper and lower drive motors. 20 and rotate. Therefore, a large difference in rotational speed is not generated between the two upper and lower drive motors 20. Therefore, it is possible to prevent the driving torque of one of the upper and lower driving motors 20 from being a large load of the other upper and lower driving motor 20, and to prevent the driving torque of the other upper and lower driving motor 20 from being driven up and down. A larger load of the motor 20 is used.
另外,由於另一方之上下驅動用馬達20隨從一方之上下驅動用馬達20而旋轉,故即便在經由減速機21等而連結於兩台上下驅動用馬達20之各個的兩個小齒輪22與齒條23相嚙合的情況時,亦能防止兩個小齒輪22之齒及齒條23之齒以過大之力相嚙合。其結果能抑制小齒輪22及齒條23之損傷,從而可利用上下驅動機構16而使支持構件7適當地上下運動。In addition, since the other upper and lower driving motor 20 rotates in accordance with one of the upper and lower driving motors 20, the two small gears 22 and the teeth that are coupled to each of the two vertical driving motors 20 via the speed reducer 21 or the like are provided. When the strips 23 are engaged, the teeth of the two pinion gears 22 and the teeth of the racks 23 can be prevented from meshing with excessive force. As a result, damage to the pinion gear 22 and the rack 23 can be suppressed, and the support member 7 can be appropriately moved up and down by the vertical drive mechanism 16.
本實施形態中,水平驅動機構17包括兩台水平驅動用馬達40。因此,與上下驅動機構16同樣地,即便在水平驅動機構17所要求之水平驅動用馬達40之總容量變大的情況下,亦可使用外形相對較小的水平驅動用馬達40,另外,水平驅動用馬達40之配置之自由度變高。因此,在本實施形態中,儘管搬送較大的基板2,亦能實現機器人1之小型化。In the present embodiment, the horizontal drive mechanism 17 includes two horizontal drive motors 40. Therefore, similarly to the vertical drive mechanism 16, even when the total capacity of the horizontal drive motor 40 required by the horizontal drive mechanism 17 is increased, the horizontal drive motor 40 having a relatively small outer shape can be used. The degree of freedom in the arrangement of the drive motor 40 is increased. Therefore, in the present embodiment, the size of the robot 1 can be reduced even if the large substrate 2 is transported.
另外,本實施形態中,由於可使用容量相對較小的水平驅動用馬達40,故即便在使用兩台水平驅動用馬達40之情況下,亦能降低機器人1之成本。進而,本實施形態中,由於可使用容量相對較小的水平驅動用馬達40,故從一台水平驅動用馬達40所傳遞之動力變小。因此,可減小對傳遞水平驅動用馬達40之動力之小齒輪42及齒條43等動力傳遞機構的傳遞動力,從而可簡化傳遞水平驅動用馬達40之動力之動力傳遞機構的構成。而且,可抑制傳遞水平驅動用馬達40之動力之動力傳遞機構的損傷。Further, in the present embodiment, since the horizontal drive motor 40 having a relatively small capacity can be used, even when the two horizontal drive motors 40 are used, the cost of the robot 1 can be reduced. Further, in the present embodiment, since the horizontal drive motor 40 having a relatively small capacity can be used, the power transmitted from one horizontal drive motor 40 is reduced. Therefore, the transmission power to the power transmission mechanism such as the pinion gear 42 and the rack 43 that transmit the power of the horizontal drive motor 40 can be reduced, and the configuration of the power transmission mechanism that transmits the power of the horizontal drive motor 40 can be simplified. Moreover, damage of the power transmission mechanism that transmits the power of the horizontal drive motor 40 can be suppressed.
另一方面,由於水平驅動機構17使用兩台水平驅動用馬達40,故有產生如下情況之虞:一方之水平驅動用馬達40(或者另一方之水平驅動用馬達40)之驅動轉矩成為另一方之水平驅動用馬達40(或者一方之水平驅動用馬達40)之較大的負載,但本實施形態中,水平馬達控制部82係藉由速度控制與轉矩控制來控制兩台水平驅動用馬達40中之一方之水平驅動用馬達40,且在除另一方之水平驅動用馬達40停止前之其他情況時,藉由轉矩控制來控制另一台水平驅動用馬達40。On the other hand, since the horizontal drive mechanism 17 uses the two horizontal drive motors 40, there is a case where the driving torque of one of the horizontal drive motors 40 (or the other horizontal drive motor 40) becomes another. The horizontal drive motor 40 (or one of the horizontal drive motors 40) has a large load. However, in the present embodiment, the horizontal motor control unit 82 controls the two horizontal drives by speed control and torque control. The horizontal drive motor 40 is one of the motors 40, and the other horizontal drive motor 40 is controlled by torque control when the other horizontal drive motor 40 is stopped.
即,在除另一方之水平驅動用馬達40停止前之其他情況時,控制一方之水平驅動用馬達40之旋轉速度,但不控制另一方之水平驅動用馬達40之旋轉速度,另一方之水平驅動用馬達40係隨從一方之水平驅動用馬達40而旋轉。因此,在除另一方之水平驅動用馬達40停止前之其他情況時,不會在兩台水平驅動用馬達40之間產生較大的旋轉速度之差,故可防止一台水平驅動用馬達40(或者另一方之水平驅動用馬達40)之驅動轉矩成為另一方之水平驅動用馬達40(或者一方之水平驅動用馬達40)之較大的負載。In other words, when the other horizontal driving motor 40 is stopped, the rotation speed of one of the horizontal driving motors 40 is controlled, but the rotation speed of the other horizontal driving motor 40 is not controlled, and the other level is The drive motor 40 rotates in accordance with one of the horizontal drive motors 40. Therefore, in the case where the other horizontal drive motor 40 is stopped, the difference in the rotational speed between the two horizontal drive motors 40 is not generated, so that one horizontal drive motor 40 can be prevented. The driving torque of the (or the other horizontal driving motor 40) is a large load of the other horizontal driving motor 40 (or one of the horizontal driving motors 40).
又,由於在除另一方之水平驅動用馬達40停止前之其他情況時,另一方之水平驅動用馬達40係隨從一方之水平驅動用馬達40而旋轉,故即便在經由滑輪48、49及皮帶50而連結於兩台水平驅動用馬達40之各個的兩個小齒輪42與齒條43相嚙合的情況時,亦可防止兩個小齒輪42之齒與齒條43之齒以過大之力相嚙合。其結果能抑制小齒輪42及齒條43之損傷,從而可利用水平驅動機構17而使本體部5適當地水平移動。In addition, when the other horizontal driving motor 40 is stopped before the other horizontal driving motor 40 is stopped, the other horizontal driving motor 40 rotates along with one of the horizontal driving motors 40, so that it is via the pulleys 48, 49 and the belt. When the two pinion gears 42 connected to the respective two horizontal drive motors 40 are engaged with the rack gear 43, the teeth of the two pinion gears 42 and the teeth of the rack gear 43 are prevented from being excessively strong. Engage. As a result, damage to the pinion gear 42 and the rack 43 can be suppressed, and the body portion 5 can be appropriately horizontally moved by the horizontal drive mechanism 17.
另外,本實施形態中,在另一方之水平驅動用馬達40停止前,另一方之水平驅動用馬達40係藉由速度控制與轉矩控制而受到控制,並且另一-方之水平驅動用馬達40之旋轉速度受到,以使兩個小齒輪42與齒條43之間的齒隙消失。因此,在基台9停止時,能使兩個小齒輪42與齒條43之間的齒隙消失。Further, in the present embodiment, before the other horizontal drive motor 40 is stopped, the other horizontal drive motor 40 is controlled by speed control and torque control, and the other horizontal drive motor is driven. The rotational speed of 40 is received so that the backlash between the two pinion gears 42 and the rack 43 disappears. Therefore, when the base 9 is stopped, the backlash between the two pinion gears 42 and the rack 43 can be eliminated.
本實施形態中,旋轉驅動機構18包括兩台旋轉驅動用馬達60。因此,與上下驅動機構16同樣地,即便在旋轉驅動機構18所要求之旋轉驅動用馬達60之總容量變大的情況下,亦能使用外形相對較小的旋轉驅動用馬達60,另外,旋轉驅動用馬達60之配置之自由度變高。因此,本實施形態中,儘管搬送較大的基板2,亦能實現機器人1之小型化。In the present embodiment, the rotation drive mechanism 18 includes two rotation drive motors 60. Therefore, similarly to the vertical drive mechanism 16, even when the total capacity of the rotary drive motor 60 required by the rotary drive mechanism 18 is increased, the rotary drive motor 60 having a relatively small outer shape can be used, and the rotation can be performed. The degree of freedom in the arrangement of the drive motor 60 is increased. Therefore, in the present embodiment, the size of the robot 1 can be reduced even if the large substrate 2 is transported.
又,本實施形態中,由於可使用容量相對較小的旋轉驅動用馬達60,故即便在使用兩台旋轉驅動用馬達60之情況時,亦能降低機器人1之成本。進而,本實施形態中,由於可使用容量相對較小的旋轉驅動用馬達60,故從一台旋轉驅動用馬達60所傳遞之動力變小。因此,可減小對傳遞旋轉驅動用馬達60之動力之輸出齒輪68及減速機61等動力傳遞機構的傳遞動力,從而可簡化傳遞旋轉驅動用馬達60之動力之動力傳遞機構的構成。而且,可抑制傳遞旋轉驅動用馬達60之動力之動力傳遞機構的損傷。Further, in the present embodiment, since the rotary drive motor 60 having a relatively small capacity can be used, even when two rotary drive motors 60 are used, the cost of the robot 1 can be reduced. Further, in the present embodiment, since the rotary drive motor 60 having a relatively small capacity can be used, the power transmitted from one rotary drive motor 60 is reduced. Therefore, the transmission power to the power transmission mechanism such as the output gear 68 and the speed reducer 61 that transmits the power of the rotary drive motor 60 can be reduced, and the configuration of the power transmission mechanism that transmits the power of the rotary drive motor 60 can be simplified. Moreover, damage of the power transmission mechanism that transmits the power of the rotation drive motor 60 can be suppressed.
另一方面,由於旋轉驅動機構18使用兩台旋轉驅動用馬達60,故有產生如下情況之虞:一方之旋轉驅動用馬達60(或者另一方之旋轉驅動用馬達60)之驅動轉矩成為另一方之旋轉驅動用馬達60(或者一方之旋轉驅動用馬達60)之較大的負載,但本實施形態中,旋轉馬達控制部83係藉由速度控制與轉矩控制來控制兩台旋轉驅動用馬達60中之一方之旋轉驅動用馬達60,且在除另一方之旋轉驅動用馬達60停止前之其他情況時,藉由轉矩控制來控制另一方之旋轉驅動用馬達60。On the other hand, since the rotation drive mechanism 18 uses the two rotation drive motors 60, there is a case where the drive torque of one of the rotation drive motors 60 (or the other rotation drive motor 60) becomes another. In the present embodiment, the rotary motor control unit 83 controls the two rotary drives by the speed control and the torque control in the one of the rotary drive motor 60 (or one of the rotary drive motors 60). One of the motors 60 is driven by the rotation drive motor 60, and the other rotation drive motor 60 is controlled by torque control when the other rotation drive motor 60 is stopped.
即,在除另一方之旋轉驅動用馬達60停止前之其他情況時,控制一方之旋轉驅動用馬達60之旋轉速度,但不控制另一方之旋轉驅動用馬達60之旋轉速度,另一方之旋轉驅動用馬達60係隨從一台旋轉驅動用馬達60而旋轉。因此,在除另一方之旋轉驅動用馬達60停止前之其他情況時,不會在兩台旋轉驅動用馬達60之間產生較大的旋轉速度之差,故可防止一方之旋轉驅動用馬達60(或者另一方之旋轉驅動用馬達60)之驅動轉矩成為另一方之旋轉驅動用馬達60(或者一方之旋轉驅動用馬達60)之較大的負載。In other words, when the other rotation drive motor 60 is stopped, the rotation speed of one of the rotation drive motors 60 is controlled, but the rotation speed of the other rotation drive motor 60 is not controlled, and the other rotation is performed. The drive motor 60 rotates in accordance with one of the rotary drive motors 60. Therefore, when the other rotation drive motor 60 is stopped, the difference between the two rotation drive motors 60 is not generated, so that one of the rotation drive motors 60 can be prevented. The driving torque of the other rotating drive motor 60 is a larger load of the other rotary drive motor 60 (or one of the rotary drive motors 60).
又,由於在除另一方之旋轉驅動用馬達60停止前之其他情況時,另一方之旋轉驅動用馬達60隨從一台旋轉驅動用馬達60而旋轉,故即便在兩個輸出齒輪68與減速機61之輸入齒輪69相嚙合的情況時,亦能防止輸出齒輪68之齒與輸入齒輪69之齒以過大之力相嚙合。其結果能抑制輸入齒輪68及輸出齒輪69之損傷,從而可利用旋轉驅動機構18而使回旋構件10適當地回旋。Further, since the other rotation drive motor 60 rotates in accordance with one rotation drive motor 60, the other two output gears 68 and the speed reducer are used. When the input gear 69 of the 61 meshes, it is also prevented that the teeth of the output gear 68 mesh with the teeth of the input gear 69 with excessive force. As a result, damage to the input gear 68 and the output gear 69 can be suppressed, and the rotary member 10 can be appropriately rotated by the rotation drive mechanism 18.
另外,本實施形態中,在另一方之旋轉驅動用馬達60停止前,另一方之旋轉驅動用馬達60係藉由速度控制與轉矩控制而受到控制,並且另一方之旋轉驅動用馬達60之旋轉速度受到控制,以使兩個輸出齒輪68與輸入齒輪69的齒隙消失。因此,在回旋構件10停止時,能使兩個輸出齒輪68與輸入齒輪69之間的齒隙消失。Further, in the present embodiment, before the other rotation drive motor 60 is stopped, the other rotation drive motor 60 is controlled by the speed control and the torque control, and the other rotation drive motor 60 is controlled. The rotational speed is controlled such that the backlash of the two output gears 68 and the input gear 69 disappears. Therefore, when the swirling member 10 is stopped, the backlash between the two output gears 68 and the input gear 69 can be eliminated.
(其他實施形態)(Other embodiments)
上述實施形態為本發明之較佳實施形態之一例,但並不限定於此,可在不變更本發明之要旨之範圍內進行各種變形實施。The embodiment described above is an example of a preferred embodiment of the present invention, and the present invention is not limited thereto, and various modifications may be made without departing from the spirit and scope of the invention.
於上述實施形態中,上下馬達控制部81係藉由速度控制與轉矩控制來控制兩台上下驅動用馬達20中之一方之上下驅動用馬達20。除此之外,例如,上下馬達控制部81亦可藉由基於對速度檢測機構檢測出的旋轉速度進行積分所計算之上下驅動用馬達20之旋轉位置的位置控制與轉矩控制,來控制一方之上下驅動用馬達20。In the above embodiment, the upper and lower motor control unit 81 controls one of the two upper and lower driving motors 20 by the speed control and the torque control. In addition, for example, the upper and lower motor control unit 81 may control the position control and the torque control of the rotational position of the upper and lower drive motors 20 by integrating the rotational speed detected by the speed detecting means. The drive motor 20 is driven up and down.
同樣地,於上述實施形態中,水平馬達控制部82係藉由速度控制與轉矩控制來控制一方之水平驅動用馬達40,並在特定情況下,藉由速度控制與轉矩控制來控制另一方之水平驅動用馬達40,但亦可藉由位置控制與轉矩控制來控制水平驅動用馬達40。又,於上述實施形態中,旋轉馬達控制部83係藉由速度控制與轉矩控制來控制一方之旋轉驅動用馬達60,並在特定情況下,藉由速度控制與轉矩控制來控制另一方之旋轉驅動用馬達60,但亦可藉由位置控制與轉矩控制來控制旋轉驅動用馬達60。Similarly, in the above embodiment, the horizontal motor control unit 82 controls one of the horizontal drive motors 40 by the speed control and the torque control, and controls the other by the speed control and the torque control in a specific case. Although one of the horizontal driving motors 40 is used, the horizontal driving motor 40 can be controlled by position control and torque control. Further, in the above embodiment, the rotary motor control unit 83 controls one of the rotary drive motors 60 by the speed control and the torque control, and in the specific case, controls the other by the speed control and the torque control. Although the motor 60 is driven to rotate, the rotation drive motor 60 can be controlled by position control and torque control.
上述實施形態中,上下驅動機構16包括兩台上下驅動用馬達20。除此之外,例如,上下驅動機構16亦可包括三台以上之上下驅動用馬達20。於該情形時,較好的是上下馬達控制部81藉由速度控制與轉矩控制來控制三台以上的上下驅動用馬達20中之若干台上下驅動用馬達20,並藉由轉矩控制來控制其餘的上下驅動用馬達20。另外,於該情形時,為了可靠地防止某一上下驅動用馬達20之驅動轉矩成為其他上下驅動用馬達20之較大的負載,較好的是上下馬達控制部81藉由速度控制與轉矩控制來控制三台以上之上下驅動用馬達20中之一台上下驅動用馬達20,並藉由轉矩控制來控制其餘的上下驅動用馬達20。In the above embodiment, the vertical drive mechanism 16 includes two upper and lower drive motors 20. In addition to this, for example, the vertical drive mechanism 16 may include three or more upper and lower drive motors 20. In this case, it is preferable that the upper and lower motor control unit 81 controls a plurality of up-and-down driving motors 20 of the three or more vertical driving motors 20 by speed control and torque control, and is controlled by torque. The remaining upper and lower drive motors 20 are controlled. Further, in this case, in order to reliably prevent the driving torque of one of the vertical driving motors 20 from being a large load of the other vertical driving motors 20, it is preferable that the upper and lower motor control units 81 control the speed by the speed. Moment control controls one of the three or more upper and lower driving motors 20, and controls the remaining up-and-down driving motors 20 by torque control.
另外,上述實施形態中,水平驅動機構17包括兩台水平驅動用馬達40,但水平驅動機構17亦可包括三台以上之水平驅動用馬達40。於該情形時,較好的是水平馬達控制部82藉由速度控制與轉矩控制來控制三台以上的水平驅動用馬達40中之若干台水平驅動用馬達40,且在其餘的水平驅動用馬達40停止前,藉由速度控制與轉矩控制來控制其餘的水平驅動用馬達40,並在除其餘的水平驅動用馬達40停止前之其他情況時,藉由轉矩控制來控制其餘的水平驅動用馬達40。另外,於該情形時,為了可靠地防止某一水平驅動用馬達40之驅動轉矩成為其他水平驅動用馬達40之較大的負載,較好的是水平馬達控制部82藉由速度控制與轉矩控制來控制三台以上之水平驅動用馬達40中之一台水平驅動用馬達40,並在除其餘的水平驅動用馬達40停止前之其他情況時,藉由轉矩控制來控制其餘的水平驅動用馬達40。Further, in the above embodiment, the horizontal drive mechanism 17 includes two horizontal drive motors 40, but the horizontal drive mechanism 17 may include three or more horizontal drive motors 40. In this case, it is preferable that the horizontal motor control unit 82 controls a plurality of the horizontal drive motors 40 of the three or more horizontal drive motors 40 by the speed control and the torque control, and is used for the remaining horizontal drive. Before the motor 40 is stopped, the remaining horizontal drive motors 40 are controlled by the speed control and the torque control, and the remaining levels are controlled by the torque control in other cases except when the remaining horizontal drive motors 40 are stopped. The drive motor 40. Further, in this case, in order to reliably prevent the driving torque of the certain horizontal driving motor 40 from becoming a large load of the other horizontal driving motor 40, it is preferable that the horizontal motor control unit 82 controls the speed by the speed. The moment control controls one of the three or more horizontal drive motors 40, and controls the remaining levels by torque control, except when the remaining horizontal drive motors 40 are stopped. The drive motor 40.
同樣地,旋轉驅動機構18亦可包括三台以上的旋轉驅動用馬達60。於該情形時,較好的是旋轉馬達控制部83藉由速度控制與轉矩控制來控制三台以上的旋轉驅動用馬達60中之若干台旋轉驅動用馬達60,且在其餘的旋轉驅動用馬達60停止前,藉由速度控制與轉矩控制來控制其餘的旋轉驅動用馬達60,並在除其餘的旋轉驅動用馬達60停止前之其他情況時,藉由轉矩控制來控制其餘的旋轉驅動用馬達60。另外,於該情形時,為了可靠地防止某一旋轉驅動用馬達60之驅動轉矩成為其他旋轉驅動用馬達60之較大的負載,較好的是旋轉馬達控制部83藉由速度控制與轉矩控制來控制三台以上之旋轉驅動用馬達60中之一台旋轉驅動用馬達60,並在除其餘的旋轉驅動用馬達60停止前之其他情況時,藉由轉矩控制來控制其餘的旋轉驅動用馬達60。Similarly, the rotation drive mechanism 18 may include three or more rotation drive motors 60. In this case, it is preferable that the rotary motor control unit 83 controls a plurality of the rotary drive motors 60 of the three or more rotary drive motors 60 by the speed control and the torque control, and the remaining rotary drive motors are used. Before the motor 60 is stopped, the remaining rotary drive motors 60 are controlled by the speed control and the torque control, and the remaining rotations are controlled by the torque control while the other rotation drive motors 60 are stopped. Drive motor 60. Further, in this case, in order to reliably prevent the driving torque of the one rotation driving motor 60 from being a large load of the other rotation driving motor 60, it is preferable that the rotation motor control unit 83 is controlled by the speed and the rotation. Moment control controls one of the three or more rotational drive motors 60, and controls the remaining rotation by torque control, except when the remaining rotary drive motors 60 are stopped. Drive motor 60.
上述實施形態中,在另一方之水平驅動用馬達40停止前,水平馬達控制部82係藉由速度控制與轉矩控制來控制另一台水平驅動用馬達40,且在除另一方之水平驅動用馬達40停止前之其他情況時,藉由轉矩控制來控制另一方之水平驅動用馬達40。除此之外,例如,水平馬達控制部82亦可始終藉由轉矩控制來控制另一方之水平驅動用馬達40。同樣地,旋轉馬達控制部83亦可始終藉由轉矩控制來控制另一方之旋轉驅動用馬達60。In the above embodiment, before the other horizontal drive motor 40 is stopped, the horizontal motor control unit 82 controls the other horizontal drive motor 40 by speed control and torque control, and is driven by the other horizontal drive. When the motor 40 is stopped, the other horizontal drive motor 40 is controlled by torque control. In addition to this, for example, the horizontal motor control unit 82 can always control the other horizontal drive motor 40 by torque control. Similarly, the rotation motor control unit 83 can also control the other rotation drive motor 60 by torque control at all times.
於上述實施形態中,上下驅動機構16、水平驅動機構17及旋轉驅動機構18之任一者均包括兩台驅動用馬達20、40、60,但只要上下驅動機構16、水平驅動機構17及旋轉驅動機構18中之至少任一個驅動機構包括兩台驅動用馬達20、40、60,則其他的驅動機構所包括之驅動用馬達20、40、60亦可為一台。In the above embodiment, each of the vertical drive mechanism 16, the horizontal drive mechanism 17, and the rotary drive mechanism 18 includes two drive motors 20, 40, and 60, but the upper and lower drive mechanisms 16, the horizontal drive mechanism 17, and the rotation are provided. At least one of the drive mechanisms 18 includes two drive motors 20, 40, and 60, and the drive motors 20, 40, and 60 included in the other drive mechanisms may be one.
於上述實施形態中,藉由兩個小齒輪22及齒條23而使支持構件7於上下方向移動。除此之外,例如亦可藉由滾珠螺桿及螺合於該滾珠螺桿之複數個螺母構件而使支持構件7於上下方向移動。同樣地,上述實施形態中,藉由兩個小齒輪42及齒條43而使基台9朝水平方向移動,但亦可藉由滾珠螺桿及螺合於該滾珠螺桿之複數個螺母構件而使基台9於水平方向移動。In the above embodiment, the support member 7 is moved in the vertical direction by the two pinion gears 22 and the racks 23. In addition to this, for example, the support member 7 can be moved in the vertical direction by a ball screw and a plurality of nut members screwed to the ball screw. Similarly, in the above embodiment, the base 9 is moved in the horizontal direction by the two pinion gears 42 and the rack 43. However, the ball screw and the plurality of nut members screwed to the ball screw may be used. The base 9 moves in the horizontal direction.
上述實施形態中,機器人1包括上下驅動機構16、水平驅動機構17、及旋轉驅動機構18。除此之外,例如,機器人1亦可僅包括從上下驅動機構16、水平驅動機構17及旋轉驅動機構18中任意選擇的兩個或一個驅動機構。In the above embodiment, the robot 1 includes a vertical drive mechanism 16, a horizontal drive mechanism 17, and a rotary drive mechanism 18. In addition to this, for example, the robot 1 may include only two or one drive mechanisms arbitrarily selected from the upper and lower drive mechanisms 16, the horizontal drive mechanism 17, and the rotary drive mechanism 18.
1...機器人(產業用機器人)1. . . Robot (industrial robot)
2...基板(搬送對象物)2. . . Substrate (transport object)
3...機械手3. . . Robot
4...臂4. . . arm
7...支持構件7. . . Support component
16...上下驅動機構16. . . Upper and lower drive mechanism
17...水平驅動機構17. . . Horizontal drive mechanism
18...旋轉驅動機構18. . . Rotary drive mechanism
20...上下驅動用馬達(驅動用馬達、第一驅動用馬達、第二驅動用馬達)20. . . Upper and lower drive motors (drive motor, first drive motor, and second drive motor)
40...水平驅動用馬達(驅動用馬達、第一驅動用馬達、第二驅動用馬達)40. . . Horizontal drive motor (drive motor, first drive motor, second drive motor)
60...旋轉驅動用馬達(驅動用馬達、第一驅動用馬達、第二驅動用馬達)60. . . Rotary drive motor (drive motor, first drive motor, second drive motor)
80...控制部80. . . Control department
81...上下馬達控制部(馬達控制部)81. . . Upper and lower motor control unit (motor control unit)
82...水平馬達控制部(馬達控制部)82. . . Horizontal motor control unit (motor control unit)
83...旋轉馬達控制部(馬達控制部)83. . . Rotary motor control unit (motor control unit)
CL...中心軸CL. . . The central axis
圖1係本發明之實施形態之產業用機器人之俯視圖;1 is a plan view of an industrial robot according to an embodiment of the present invention;
圖2係從圖1之E-E方向表示產業用機器人之示圖;2 is a view showing an industrial robot from the E-E direction of FIG. 1;
圖3係從圖1之F-F方向表示產業用機器人之示圖;3 is a view showing an industrial robot from the F-F direction of FIG. 1;
圖4係從圖1之F-F方向表示支持構件及上下驅動機構之示圖;Figure 4 is a view showing the support member and the upper and lower drive mechanisms from the F-F direction of Figure 1;
圖5係從圖4之G-G方向表示支持構件、柱狀構件及上下驅動機構之示圖;Figure 5 is a view showing the support member, the columnar member, and the upper and lower drive mechanisms from the G-G direction of Figure 4;
圖6係從圖4之H-H方向表示上下驅動機構之示圖;Figure 6 is a view showing the upper and lower drive mechanisms from the H-H direction of Figure 4;
圖7係用以說明圖2之J部之內部構成的示圖;Figure 7 is a view for explaining the internal structure of the J portion of Figure 2;
圖8係用以從圖3之K-K方向來說明水平驅動機構等之構成的示圖;Figure 8 is a view for explaining the configuration of a horizontal drive mechanism or the like from the K-K direction of Figure 3;
圖9係用以從圖8之L-L方向來說明水平驅動機構之構成的示圖;Figure 9 is a view for explaining the configuration of the horizontal drive mechanism from the L-L direction of Figure 8;
圖10係圖1所示之回旋構件之俯視圖;Figure 10 is a plan view of the convoluted member shown in Figure 1;
圖11係圖10之M-M剖面之剖面圖;及Figure 11 is a cross-sectional view of the M-M section of Figure 10;
圖12係圖1所示之產業用機器人之控制部及其相關部分之方框圖。Figure 12 is a block diagram showing the control unit of the industrial robot shown in Figure 1 and its related parts.
20...上下驅動用馬達20. . . Upper and lower drive motor
24...上下制動機構twenty four. . . Upper and lower brake mechanism
40...水平驅動用馬達40. . . Horizontal drive motor
44...水平制動機構44. . . Horizontal brake mechanism
60...旋轉驅動用馬達60. . . Rotary drive motor
64...旋轉制動機構64. . . Rotary brake mechanism
80...控制部80. . . Control department
81...上下馬達控制部81. . . Upper and lower motor control unit
82...水平馬達控制部82. . . Horizontal motor control unit
83...旋轉馬達控制部83. . . Rotary motor control unit
84...上下制動器控制部84. . . Upper and lower brake control unit
85...水平制動器控制部85. . . Horizontal brake control unit
86...旋轉制動器控制部86. . . Rotary brake control unit
87...控制指令部87. . . Control command department
Claims (6)
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008216542A JP5241382B2 (en) | 2008-08-26 | 2008-08-26 | Industrial robot |
Publications (2)
Publication Number | Publication Date |
---|---|
TW201026461A TW201026461A (en) | 2010-07-16 |
TWI480143B true TWI480143B (en) | 2015-04-11 |
Family
ID=41787409
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW098128550A TWI480143B (en) | 2008-08-26 | 2009-08-25 | Industrial robot |
Country Status (4)
Country | Link |
---|---|
JP (1) | JP5241382B2 (en) |
KR (1) | KR101498301B1 (en) |
CN (1) | CN101659055B (en) |
TW (1) | TWI480143B (en) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017024096A (en) * | 2015-07-17 | 2017-02-02 | 日本電産サンキョー株式会社 | Industrial robot and control method for industrial robot |
CN109661297B (en) * | 2016-09-23 | 2021-07-23 | 雅马哈发动机株式会社 | Robot |
CN108145528A (en) * | 2016-12-05 | 2018-06-12 | 新昌县嘉德科技发展有限公司 | A kind of control device of lathe |
CN108742158A (en) * | 2018-08-16 | 2018-11-06 | 杭州道森科技有限公司 | A kind of Multi-freedom-degreemanipulator manipulator |
CN110587635A (en) * | 2019-08-02 | 2019-12-20 | 湖南海纳赋能科技有限公司 | Intelligent storage manipulator for locker |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03126102A (en) * | 1989-10-12 | 1991-05-29 | Sony Corp | Device and method for robot control |
JPH10295744A (en) * | 1997-04-24 | 1998-11-10 | Aikoku Alpha Kk | Human harmonizing type nursing support device |
JP2006102886A (en) * | 2004-10-06 | 2006-04-20 | Nidec Sankyo Corp | Robot |
TW200914221A (en) * | 2006-12-01 | 2009-04-01 | Nidec Sankyo Corp | Arm driving device and industrial robot |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06106487A (en) * | 1992-09-29 | 1994-04-19 | Fanuc Ltd | Straight line travel mechanism for straight line travel machine body such as robot |
JP4063781B2 (en) * | 2004-03-04 | 2008-03-19 | 株式会社ラインワークス | Transport device |
JP4240079B2 (en) * | 2006-07-20 | 2009-03-18 | 株式会社安川電機 | Substrate transfer device with dustproof mechanism |
CN100562410C (en) * | 2006-11-10 | 2009-11-25 | 沈阳新松机器人自动化股份有限公司 | A kind of planar multiple-articulation robot |
-
2008
- 2008-08-26 JP JP2008216542A patent/JP5241382B2/en active Active
-
2009
- 2009-08-25 TW TW098128550A patent/TWI480143B/en active
- 2009-08-25 CN CN200910171054.3A patent/CN101659055B/en not_active Expired - Fee Related
- 2009-08-26 KR KR1020090079129A patent/KR101498301B1/en active IP Right Grant
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03126102A (en) * | 1989-10-12 | 1991-05-29 | Sony Corp | Device and method for robot control |
JPH10295744A (en) * | 1997-04-24 | 1998-11-10 | Aikoku Alpha Kk | Human harmonizing type nursing support device |
JP2006102886A (en) * | 2004-10-06 | 2006-04-20 | Nidec Sankyo Corp | Robot |
TW200914221A (en) * | 2006-12-01 | 2009-04-01 | Nidec Sankyo Corp | Arm driving device and industrial robot |
Also Published As
Publication number | Publication date |
---|---|
CN101659055A (en) | 2010-03-03 |
JP5241382B2 (en) | 2013-07-17 |
KR101498301B1 (en) | 2015-03-11 |
KR20100024909A (en) | 2010-03-08 |
JP2010052054A (en) | 2010-03-11 |
CN101659055B (en) | 2014-08-06 |
TW201026461A (en) | 2010-07-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TWI480140B (en) | Industrial robot | |
TWI480143B (en) | Industrial robot | |
JP6173678B2 (en) | Industrial robot and control method for industrial robot | |
JP6607661B2 (en) | Horizontal articulated robot | |
JP5200004B2 (en) | Adsorption pad, friction stir welding device, friction stir welding system | |
US20080081728A1 (en) | Continuously Variable Transmission with Mutliple Outputs | |
TWI481487B (en) | Industrial robots | |
KR101498300B1 (en) | Industrial Robot | |
WO2012059791A1 (en) | Robotic snake-like movement device | |
JP2016182664A (en) | Mechanical gripper driving device | |
CN202895245U (en) | Arm assembly for industrial robot and industrial robot | |
JP2012250320A5 (en) | ||
JP2014076522A (en) | Robot hand and robot device | |
JP6199284B2 (en) | Robot driving method, robot, translational robot, robot system, and robot system driving method | |
JP5262810B2 (en) | Parallel mechanism | |
TWI388744B (en) | Straight-rotary motion mechanism | |
US8511196B2 (en) | Traction drive system | |
JP2013132711A (en) | Parallel link robot | |
JP2020023032A (en) | Cooperative robot | |
KR200428064Y1 (en) | Linear actuator | |
JP2019150912A (en) | Driving device, deriving method of driving device, hand, robot and carrying device | |
JP2022104003A (en) | Robot and control method of robot | |
CN112178153B (en) | Under-actuated device using differential and friction clutch | |
JP6783474B2 (en) | A table drive device and a work system equipped with the table drive device | |
WO2022070924A1 (en) | Industrial robot hand and industrial robot |