Robot and robot control method

By integrating a temperature sensor and control unit to compensate for thermal expansion in robot arms, gears, and shafts, the robot achieves stable positioning accuracy despite temperature fluctuations.

KR103045264B1Active Publication Date: 2026-11-06KAWASAKI JUKOGYO KK
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
KR1020247019187
Authority / Receiving Office
KR · KR
Patent Type
Patents
Current Assignee / Owner
Priority Date
2022-02-03
Filing Date
2022-12-07
Publication Date
2026-11-06
Estimated Expiration
2042-12-07

AI Technical Summary

Technical Problem

Existing robots with robot arms face challenges in securing stable positioning accuracy due to thermal expansion effects on parts other than the arm, leading to instability in positioning accuracy with temperature changes.

Method used

Incorporating a temperature sensor to detect thermal expansion in the robot arm, gear, and shaft, and a control unit to correct the effects of thermal expansion between these components, ensuring accurate positioning by compensating for thermal expansion across multiple parts.

Benefits of technology

Stable positioning accuracy is achieved by correcting thermal expansion effects in the robot arm, gear, and shaft, enhancing stability against temperature changes.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 112024061778155-PCT00011_ABST
    Figure 112024061778155-PCT00011_ABST
Patent Text Reader

Abstract

The robot (100) includes a robot arm (10), a gear (431), and a shaft (44), and has a driving mechanism (40) for driving the robot arm, a temperature sensor (50) for detecting the temperature of the robot arm, and a control unit (30) for correcting the effect caused by thermal expansion between the robot arm, the gear, and the shaft based on the detection result of the temperature sensor.
Need to check novelty before this filing date? Find Prior Art

Description

Technology Field

[0001] This disclosure relates to a robot and a method for controlling the robot. Background Technology

[0002] Conventionally, a robot equipped with a robot arm is known. Such a robot is disclosed, for example, in Japanese Patent Publication No. 6398204.

[0003] Japanese Patent Publication No. 6398204 disclosed above is a robot equipped with a robot arm. In this robot, when the robot arm is operated, the motor and gear reduction device generate heat. Therefore, in this robot, the change in the length of the robot arm's link due to temperature changes is compensated for. Prior art literature

[0004] Japanese Patent Publication No. 6398204 The problem to be solved

[0005] However, in the robot described in the aforementioned Japanese Patent Publication No. 6398204, since only the length change caused by the thermal expansion of the robot arm links due to temperature changes is compensated, the influence caused by thermal expansion of parts other than the robot arm is not sufficiently compensated. In this case, there is a problem in that it is difficult to secure stable positioning accuracy with respect to temperature changes.

[0006] This disclosure is made to solve the above-mentioned problem and provides a robot and a method for controlling the robot that can secure stable positioning accuracy with respect to temperature changes, compared to the case where only the effect caused by thermal expansion of the robot arm is corrected. means of solving the problem

[0007] A robot according to the first phase of this disclosure comprises a robot arm, a gear, and a shaft, a driving mechanism for driving the robot arm, a temperature sensor for detecting the temperature of the robot arm, and a control unit for correcting the effect caused by thermal expansion between at least one of the robot arm, the gear, and the shaft based on the detection result of the temperature sensor.

[0008] The robot according to the first phase of this disclosure forms a control unit that corrects the effect caused by thermal expansion between the robot arm and at least one of the gear and shaft part, based on the detection result of the temperature sensor as described above. By doing so, not only the effect caused by thermal expansion of the robot arm but also the effect caused by thermal expansion of at least one of the gear and shaft part can be corrected. As a result, positioning accuracy that is stable with respect to temperature changes can be secured compared to the case where only the effect caused by thermal expansion of the robot arm is corrected.

[0009] A robot according to the second phase of this disclosure comprises a robot arm, a power transmission unit, and an axle unit, a driving mechanism for driving the robot arm, a temperature sensor for detecting the temperature of the robot arm, and a control unit for correcting the effect caused by thermal expansion between at least one of the robot arm, the power transmission unit, and the axle unit based on the detection result of the temperature sensor.

[0010] The robot according to the second phase of this disclosure forms a control unit that corrects the effects caused by thermal expansion between the robot arm and at least one of the power transmission unit and the shaft unit, based on the detection result of the temperature sensor as described above. By doing so, not only the effects caused by thermal expansion of the robot arm but also the effects caused by thermal expansion of at least one of the power transmission unit and the shaft unit can be corrected. As a result, stable positioning accuracy with respect to temperature changes can be secured compared to the case where only the effects caused by thermal expansion of the robot arm are corrected.

[0011] A control method for a robot according to the third phase of this disclosure comprises driving a robot arm by a driving mechanism including a gear and a shaft, detecting the temperature of the robot arm by a temperature sensor, and correcting the effect caused by thermal expansion between the robot arm and at least one of the gear and the shaft based on the detection result of the temperature sensor.

[0012] The control method of a robot according to the third phase of this disclosure corrects the effect caused by thermal expansion between the robot arm and at least one of the gear and shaft part based on the detection result of the temperature sensor as described above. By doing so, not only the effect caused by thermal expansion of the robot arm but also the effect caused by thermal expansion of at least one of the gear and shaft part can be corrected. As a result, positioning accuracy that is stable with respect to temperature changes can be secured compared to the case where only the effect caused by thermal expansion of the robot arm is corrected.

[0013] Compared to the case where only the effects caused by the thermal expansion of the robot arm are compensated for, stable positioning accuracy can be secured with respect to temperature changes. Brief explanation of the drawing

[0014] FIG. 1 is a drawing showing the configuration of a robot according to one embodiment. FIG. 2 is a block diagram showing the configuration of a robot according to one embodiment. FIG. 3 is a drawing showing the configuration of a driving mechanism according to one embodiment. Figure 4 is a diagram illustrating the effects caused by thermal expansion of the robot arm and gear. Figure 5 is a diagram illustrating the effects caused by thermal expansion of the shaft. FIG. 6 is a drawing for explaining the correction of substrate position misalignment of a robot according to one embodiment. FIG. 7 is a flowchart illustrating the correction process for the effect of thermal expansion of a robot according to one embodiment. Specific details for implementing the invention

[0015] Hereinafter, embodiments embodying the present disclosure will be described based on the drawings.

[0016] (Robot composition)

[0017] With reference to FIGS. 1 through 6, the configuration of a robot (100) according to one embodiment will be described. As shown in FIG. 1, the robot (100) is a substrate transport robot. The robot (100) is placed in a clean room (200). Also, the robot (100) is placed under a vacuum environment. Specifically, the robot (100) is placed inside a vacuum chamber (201).

[0018] The robot (100) is equipped with a robot arm (10), a substrate holding hand (20) positioned at the tip of the robot arm (10), and a control unit (30). The substrate holding hand (20) holds a substrate (W). Specifically, the substrate holding hand (20) is a passive hand that holds the substrate (W) by frictional force. The substrate (W) is, for example, a semiconductor wafer. A predetermined process is performed on the semiconductor wafer in a processing room (202).

[0019] The robot arm (10) is a horizontal multi-joint robot arm. The robot arm (10) includes a first arm section (11) and a second arm section (12). One end of the first arm section (11) is connected to a base section (13) via a first joint (JT1). One end of the second arm section (12) is connected to the other end of the first arm section (11) via a second joint (JT2). A substrate holding hand (20) is connected to the other end of the second arm section (12) via a third joint (JT3).

[0020] The first joint (JT1) rotates the first arm portion (11) relative to the base portion (13) around a first rotation axis (A1) extending in the up-and-down direction. The second joint (JT2) rotates the second arm portion (12) relative to the first arm portion (11) around a second rotation axis (A2) extending in the up-and-down direction. The third joint (JT3) rotates the substrate holding hand (20) relative to the second arm portion (12) around a third rotation axis (A3) extending in the up-and-down direction.

[0021] In each joint of the first joint (JT1), the second joint (JT2), and the third joint (JT3), a driving mechanism (40) for driving the robot arm (10) is formed, as shown in FIG. 2. The driving mechanism (40) of the first joint (JT1) is positioned in the first arm portion (11), the driving mechanism (40) of the second joint (JT2) is positioned in the first arm portion (11), and the driving mechanism (40) of the third joint (JT3) is positioned in the second arm portion (12). Furthermore, the positioning of the driving mechanism (40) is not limited to this.

[0022] The driving mechanism (40) includes a motor (41) made of a servo motor, a position sensor (42) that detects the rotational position of the output shaft of the motor (41), a power transmission unit (43) that transmits the driving force of the motor (41), and a shaft unit (44) that rotates an object such as a first arm unit (11), a second arm unit (12), and a substrate holding hand (20) by the driving force from the power transmission unit (43).

[0023] As shown in FIG. 3, the power transmission unit (43) includes a gear (431). The gear (431) has an output gear (431a) and a plurality of input gears (431b, 431c). The input gear (431c) is a bevel gear, with its input side connected to the motor (41) and its output shaft connected to the output gear (431b). The input gear (431b) is a bevel gear, with its input side connected to the input gear (431c) and its output side connected to the output gear (431a). The output gear (431a) is a helical gear, with its input side connected to the input gear (431b) and its output side connected to the pivot shaft (441) of the shaft unit (44) described later.

[0024] Additionally, the shaft portion (44) includes a pivot shaft (441) and a bearing (442) into which the pivot shaft (441) is inserted. The pivot shaft (441) has its input side connected to an output gear (431a) and its output side connected to an object such as a first arm portion (11), a second arm portion (12), and a substrate holding hand (20). As the pivot shaft (441) rotates, the object rotates. The bearing (442) rotatably supports the pivot shaft (441). The bearing (442) is mounted in a housing (443) of the first arm portion (11) and the second arm portion (12), etc. Additionally, the power transmission portion (43) and the shaft portion (44) are not limited to the configuration of FIG. 3.

[0025] Also, as shown in FIG. 2, a temperature sensor (50) for detecting the temperature of the robot arm (10) is formed in the robot arm (10). The temperature sensor (50) is formed in each of the first arm portion (11) and the second arm portion (12). Specifically, the temperature sensor (50) is positioned at the tip and base portions of the first arm portion (11). Also, the temperature sensor (50) is positioned at the tip and base portions of the second arm portion (12). The temperature sensor (50) is, for example, a thermocouple. The temperature sensor (50) is positioned on the inner surface of the first arm portion (11) and the second arm portion (12).

[0026] The control unit (30) controls the operation of the robot arm (10) by executing a predetermined program. The control unit (30) controls the operation of the robot arm (10) by controlling the power supplied to the motors (41) formed at each joint of the first joint (JT1), the second joint (JT2), and the third joint (JT3).

[0027] Here, when the robot arm (10) is operated, the robot arm (10) expands thermally due to the heat of the motor (41), etc. When the robot arm (10) expands thermally, a position error with respect to the target position occurs due to the thermal expansion.

[0028] Also, as shown in FIG. 4, when the robot arm (10) undergoes thermal expansion, the distance (D1) between the center points of the gears (431) changes due to the difference in the amount of thermal expansion between the robot arm (10) and the gears (431), and the backlash between the gears (431) changes. If the amount of thermal expansion of the robot arm (10) is greater than the amount of thermal expansion of the gears (431), the distance (D1) between the center points of the gears (431) widens, and the backlash between the gears (431) increases. When the backlash between the gears (431) changes, an angle error occurs due to the change in backlash, and thus a position error with respect to the target position occurs. Also, in FIG. 4, for convenience, the robot arm (10), input gear (431b), and output gear (431a) are simplified.

[0029] Also, as shown in FIG. 5, the effect of thermal expansion occurs in the shaft portion (44). That is, if the bearing (442) thermally expands due to the heat of the motor (41), the preload of the bearing (442) is reduced, and the torsional rigidity of the shaft portion (44) decreases. Also, the torsional rigidity of the shaft portion (44) decreases due to changes in the physical properties of the rotating shaft (441) or the housing (443) caused by heat. When the torsional rigidity of the shaft portion (44) decreases, an angle error occurs due to the decrease in the torsional rigidity of the shaft portion (44), and thus a position error with respect to the target position occurs.

[0030] Here, in this embodiment, the control unit (30) corrects the effect caused by thermal expansion between the robot arm (10), the power transmission unit (43), and the shaft unit (44) based on the detection result of the temperature sensor (50). That is, the control unit (30) corrects the effect caused by thermal expansion between the robot arm (10), the gear (431), and the shaft unit (44) based on the detection result of the temperature sensor (50). The control unit (30) corrects the positional misalignment of the robot arm (10) caused by the change in the length of the robot arm (10) due to thermal expansion. The control unit (30) corrects the amount of rotational misalignment of the robot arm (10) caused by changes in backlash between gears (431) due to thermal expansion of the robot arm (10), and by a decrease in torsional rigidity of the shaft (44) due to thermal expansion.

[0031] Also, in this embodiment, the control unit (30) corrects the effect of backlash between the gears (431) caused by thermal expansion based on the detection result of the temperature sensor (50) and the thermal expansion coefficient between the robot arm (10) and the gear (431).

[0032] In addition, in this embodiment, the robot arm (10) and the gear (431) are formed from materials with different coefficients of thermal expansion. The first arm portion (11) and the second arm portion (12) of the robot arm (10) are formed from aluminum. The output gear (431a) and input gear (431b, 431c) of the gear (431) are formed from iron. Also, the coefficient of thermal expansion of aluminum is greater than the coefficient of thermal expansion of iron. The control unit (30) corrects the effect of backlash between the gears (431) caused by thermal expansion based on the detection result of the temperature sensor (50) and the difference in the coefficients of thermal expansion between the robot arm (10) and the gear (431).

[0033] Also, in this embodiment, the control unit (30) corrects the effect of backlash caused by thermal expansion between the output gear (431a) and the input gear (431b) on the side of the output gear (431a) among the plurality of input gears (431b, 431c). Since the effect of backlash caused by thermal expansion between the input gears (431b, 431c) is smaller than the effect of backlash caused by thermal expansion between the output gear (431a) and the input gear (431b), the control unit (30) does not correct the effect of backlash caused by thermal expansion between the input gears (431b, 431c).

[0034] In addition, in this embodiment, the control unit (30) corrects the effect of the decrease in torsional rigidity of the shaft (44) caused by thermal expansion based on the detection result of the temperature sensor (50) and the operating torque of the driving mechanism (40). In addition, details of the correction will be described later.

[0035] Here, with reference to FIG. 6, the correction of positional misalignment in the substrate holding hand (20) of the substrate (W) is described.

[0036] As shown in FIG. 6, the position of the substrate (W) in the substrate holding hand (20) may become misaligned during substrate transport. Misalignment of the position of the substrate (W) during substrate transport is likely to occur when the substrate holding hand (20) is a passive hand that holds the substrate (W) only by frictional force. For this reason, a position misalignment detection device (60) is formed near the processing room (202).

[0037] The position misalignment detection device (60) is equipped with a first sensor (61) and a second sensor (62). The first sensor (61) and the second sensor (62) are non-contact sensors. For the first sensor (61) and the second sensor (62), a reflective sensor or a transmissive sensor may be used.

[0038] The first sensor (61) and the second sensor (62) detect the passage of the outer edge of the substrate (W) while the substrate (W) is being transported to the processing room (202). The detection results of the first sensor (61) and the second sensor (62) are input to the control unit (30). The control unit (30) obtains the center position of the substrate holding hand (20) at the timing when the first sensor (61) and the second sensor (62) detect the passage of the outer edge of the substrate (W), for example, by the position sensor (42) of each joint.

[0039] During the process of the substrate (W) being transported along this path, the first sensor (61) detects the passage of the outer edge of the substrate (W) twice. The first detection is shown on the left side of FIG. 6, and the second detection is shown on the right side of FIG. 6. At the timing of the two passages, the control unit (30) calculates the center position of the substrate holding hand (20).

[0040] Here, virtual circles (C1, C2) with a diameter equal to the diameter of the substrate (W) are centered on the center (20a) of the two substrate holding hands (20). Virtual circle (C1) is a virtual circle based on the first detection, and virtual circle (C2) is a virtual circle based on the second detection. On the right side of FIG. 6, the virtual circle (C1) based on the first detection is drawn together with the virtual circle (C2) based on the second detection.

[0041] There are two intersection points of the virtual circles (C1, C2), as shown on the right side of FIG. 6. Among the two intersection points, attention is paid to the intersection point closer to the first sensor (61). The location of this intersection point can be easily obtained by known geometric calculations. The control unit (30) obtains a planar vector indicating the misalignment between the noted intersection point and the location of the first sensor (61). This planar vector is indicated by a white arrow on the right side of FIG. 6. This misalignment can be considered equivalent to the positional misalignment between the center (20a) of the substrate holding hand (20) and the center (Wa) of the substrate (W).

[0042] Since the detection of positional misalignment of the substrate (W) by the second sensor (62) is the same as in the case of the first sensor (61), a detailed description is omitted. The control unit (30) obtains the average value of the planar vector obtained from the detection result of the first sensor (61) and the planar vector obtained from the detection result of the second sensor (62), and uses the obtained average value as the correction amount for the positional misalignment of the substrate (W) at the substrate holding hand (20), thereby correcting the positional misalignment of the substrate (W) at the substrate holding hand (20). By obtaining the average value, the positional misalignment of the substrate (W) relative to the substrate holding hand (20) can be obtained with good precision. Additionally, either the first sensor (61) or the second sensor (62) may be omitted.

[0043] Here, when correcting the positional misalignment of the substrate (W) in the substrate holding hand (20), the amount of correction for the positional misalignment of the substrate (W) in the substrate holding hand (20) also includes the influence caused by thermal expansion. Therefore, the control unit (30) corrects not only the influence caused by thermal expansion at the target position, but also the influence caused by thermal expansion included in this correction amount. Below, this point will be explained using a mathematical formula.

[0044] First, the effect caused by thermal expansion of the robot arm (10) is explained. The lengths of the first arm section (11) and the second arm section (12) after thermal expansion are represented by the following equations (1) and (2). The control unit (30) can correct the effect caused by thermal expansion of the robot arm (10) based on the following equations (1) and (2).

[0045] [Mathematical Formula 1]

[0046]

[0047] Here,

[0048] L' X1 : Length of the first arm (11) after thermal expansion [mm]

[0049] L' X2 : Length of the second arm (12) after thermal expansion [mm]

[0050] L X1 : Length of the first arm (11) at the reference temperature before thermal expansion [mm]

[0051] L X2 : Length of the second arm (12) at the reference temperature before thermal expansion [mm]

[0052] a Al : Thermal expansion coefficient of the first arm (11) and the second arm (12) [ / 10 6 K]

[0053] T L1root : Reference temperature [°C] of the source of the first arm section (11)

[0054] T L1tip : Reference temperature [°C] of the tip of the first arm section (11)

[0055] T U1root : Reference temperature [°C] of the source of the second arm section (12)

[0056] T U1tip : Reference temperature [°C] of the tip of the second arm (12)

[0057] TL2root : Detected temperature [°C] of the temperature sensor (50) at the source of the first arm (11)

[0058] T L2tip : Detected temperature [°C] of the temperature sensor (50) at the tip of the first arm (11)

[0059] T U2root : Detected temperature [°C] of the temperature sensor (50) at the source of the second arm (12)

[0060] T U2tip : Detected temperature [°C] of the temperature sensor (50) at the tip of the second arm (12)

[0061] am.

[0062] T L1root , T L1tip , T U1root , T U1tip is predetermined. T L2root , T L2tip , T U2root , T U2tip It is acquired from the temperature sensor (50) at a predetermined timing, such as when correcting the position misalignment in the substrate holding hand (20) of the substrate (W).

[0063] Next, the effect of backlash between gears (431) due to thermal expansion is explained. The amount of change in the distance between the center points of the output gear (431a) and the input gear (431b) per unit temperature is represented by the following equation (3).

[0064] [Mathematical Formula 2]

[0065]

[0066] Here,

[0067] J rJT* : Change in distance between the center points of the output gear (431a) and the input gear (431b) of each joint per unit temperature [mm / K]

[0068] L JT*: Distance [mm] between the center points of the output gear (431a) and the input gear (431b) of each joint at the reference temperature before thermal expansion

[0069] a Al : Thermal expansion coefficient of the first arm (11) and the second arm (12) [ / 10 6 K]

[0070] a Fe : Thermal expansion coefficient of output gear (431a) and input gear (431b) [ / 10 6 K]

[0071] am.

[0072] Also, the amount of change in the normal direction backlash of the output gear (431a) and input gear (431b) per unit temperature is expressed by the following equation (4).

[0073] [Mathematical Formula 3]

[0074]

[0075] Here,

[0076] J nJT* : Change in normal backlash of the output gear (431a) and input gear (431b) of each joint per unit temperature [mm / K]

[0077] J rJT* : Change in distance between the center points of the output gear (431a) and the input gear (431b) of each joint per unit temperature [mm / K]

[0078] α JT* : Pressure angle [deg] of the output gear (431a) and input gear (431b) of each joint

[0079] am.

[0080] Also, the amount of change in circumferential backlash of the output gear (431a) and input gear (431b) per unit temperature is expressed by the following equation (5).

[0081] [Mathematical Formula 4]

[0082]

[0083] Here,

[0084] J tJT* : Change in circumferential backlash of the output gear (431a) and input gear (431b) of each joint per unit temperature [mm / K]

[0085] J nJT* : Change in normal backlash of the output gear (431a) and input gear (431b) of each joint per unit temperature [mm / K]

[0086] α JT* : Pressure angle [deg] of the output gear (431a) and input gear (431b) of each joint

[0087] β JT* : Torsion angle [deg] of the output gear (431a) and input gear (431b) of each joint

[0088] am.

[0089] Also, the amount of change in the angle of backlash of the output gear (431a) and the input gear (431b) per unit temperature is expressed by the following equation (6).

[0090] [Mathematical Formula 5]

[0091]

[0092] Here,

[0093] J θJT* : Angle change of backlash of the output gear (431a) and input gear (431b) of each joint per unit temperature [deg / K]

[0094] J tJT* : Change in circumferential backlash of the output gear (431a) and input gear (431b) of each joint per unit temperature [mm / K]

[0095] d JT* : Pitch circle diameter of the output gear (431a) of each joint [mm]

[0096] am.

[0097] Additionally, the amount of change in the angle of backlash between the output gear (431a) and the input gear (431b) due to thermal expansion is expressed by the following equations (7), (8), and (9). The control unit (30) can correct the effect of backlash between the output gear (431a) and the input gear (431b) caused by thermal expansion based on the following equations (7), (8), and (9). That is, the control unit (30) can [represent] the amount of rotational misalignment θ B[JT*, ***, port] By doing so, the amount of rotational misalignment of the robot arm (10) caused by backlash between the output gear (431a) and the input gear (431b) can be corrected.

[0098] [Mathematical Formula 6]

[0099]

[0100] Here,

[0101] θ B[JT*, ***, port] : Amount of change in backlash angle between the output gear (431a) and the input gear (431b) of each joint due to thermal expansion [deg]

[0102] J θJT* : Angle change of backlash of the output gear (431a) and input gear (431b) of each joint per unit temperature [deg / K]

[0103] J d[JT*, ***, port] : Direction of influence of backlash between the output gear (431a) and input gear (431b) of each joint [1 or -1]

[0104] T L1root : Reference temperature [°C] of the source of the first arm section (11)

[0105] T L1tip : Reference temperature [°C] of the tip of the first arm section (11)

[0106] T U1tip : Reference temperature [°C] of the tip of the second arm (12)

[0107] T L2root: Detected temperature [°C] of the temperature sensor (50) at the source of the first arm (11)

[0108] T L2tip : Detected temperature [°C] of the temperature sensor (50) at the tip of the first arm (11)

[0109] T U2tip : Detected temperature [°C] of the temperature sensor (50) at the tip of the second arm (12)

[0110] am.

[0111] Also, *** is tip, root, or teach. tip indicates that the robot arm (10) is in the posture state at the first detection when correcting the position misalignment at the substrate holding hand (20) of the substrate (W). root indicates that the robot arm (10) is in the posture state at the second detection when correcting the position misalignment at the substrate holding hand (20) of the substrate (W). teach indicates that the robot arm (10) is in the posture state at the target position, which is the teaching position. Also, port indicates an access point of the robot arm (10), such as a processing room (202). That is, equations (7), (8), and (9) mean that when the robot arm (10) accesses a predetermined access point, the amount of change in the angle of backlash is calculated for each posture of the robot arm (10), such as tip, root, or teach.

[0112] Also, J d[JT*, ***, port] represents the direction of backlash influence and can take a value of 1 or -1. J d[JT*, ***, port] For example, it becomes 1 if the direction of backlash influence is clockwise, and -1 if it is counter-clockwise. J d[JT*, ***, port] It is determined based on the port, tip, root, or teach, which are access points of the robot arm (10).

[0113] Next, the effect caused by thermal expansion of the shaft (44) is explained. The amount of change in angle due to the decrease in torsional rigidity of the shaft (44) caused by thermal expansion is represented by the following equations (10), (11), and (12). The control unit (30) can correct the effect caused by thermal expansion of the shaft (44) based on the following equations (10), (11), and (12). That is, the control unit (30) can [correct] the amount of rotational misalignment θ τ[JT*, ***, port] By doing so, the amount of rotational misalignment of the robot arm (10) can be corrected due to the reduction in torsional rigidity of the shaft (44).

[0114] [Mathematical Formula 7]

[0115]

[0116] Here,

[0117] θ τ[JT*, ***, port] : Amount of angle change due to the decrease in torsional stiffness of the axis (44) of each joint due to thermal expansion [deg]

[0118] τ [JT*, ***, port] : Operating torque [Nm] of the driving mechanism (40) of each joint

[0119] G JT* : Torsional stiffness [Nm / deg] at reference temperature of the axis (44) of each joint

[0120] ΔG JT* : Change in torsional stiffness of each joint's axis (44) per unit temperature [Nm / (deg·K)]

[0121] T L1root : Reference temperature [°C] of the source of the first arm section (11)

[0122] T L1tip : Reference temperature [°C] of the tip of the first arm section (11)

[0123] T U1tip : Reference temperature [°C] of the tip of the second arm (12)

[0124] T L2root: Detected temperature [°C] of the temperature sensor (50) at the source of the first arm (11)

[0125] T L2tip : Detected temperature [°C] of the temperature sensor (50) at the tip of the first arm (11)

[0126] T U2tip : Detected temperature [°C] of the temperature sensor (50) at the tip of the second arm (12)

[0127] am.

[0128] In addition, *** and port are as described above. That is, equations (10), (11), and (12) mean that when the robot arm (10) accesses a predetermined access point, the amount of angle change due to the reduction in torsional rigidity is calculated for each position of the robot arm (10), such as tip, root, or teach.

[0129] Also, G JT* is and ΔG JT* This can be obtained through experiments, etc. For example, when the rotation of the motor (41) is fixed and a worker adds torque to the robot arm (10) and measures the rotation angle of the robot arm (10), the relationship between the torque and the rotation angle can be obtained, and thus the torsional rigidity of the shaft (44) can be obtained. Also, when the torsional rigidity of the shaft (44) is obtained while changing the temperature of the robot arm (10), the relationship between the temperature and the torsional rigidity can be obtained, and thus the amount of change in screw rigidity of the shaft (44) per unit temperature can be obtained.

[0130] Also, the final angle of each joint, including the effect caused by thermal expansion, is represented by the following equation (13).

[0131] [Mathematical Formula 8]

[0132]

[0133] Here,

[0134] θL[JT*, ***, port] : Final angle of each joint including effects due to thermal expansion [ deg ]

[0135] θ [JT*, ***, port] : Angle of each joint [deg] excluding effects due to thermal expansion

[0136] θ B[JT*, ***, port] : Amount of change in backlash angle between the output gear (431a) and the input gear (431b) of each joint due to thermal expansion [deg]

[0137] θ τ[JT*, ***, port] : Amount of angle change due to the decrease in torsional stiffness of the axis (44) of each joint due to thermal expansion [deg]

[0138] am.

[0139] Additionally, the correction amount in the X and Y directions of the effect caused by thermal expansion is expressed by the following equations (14) and (15). Based on equations (14) and (15), the control unit (30) can correct the backlash between the robot arm (10), the output gear (431a), and the input gear (431b), and the effect caused by thermal expansion of the shaft (44).

[0140] [Mathematical Formula 9]

[0141]

[0142] Here,

[0143] X off[port] : Correction amount in the X-direction for the effect attributable to thermal expansion

[0144] Y off[port] : Correction amount in the Y-direction for the effect attributable to thermal expansion

[0145] X : θ [JT1, ***, port] , θ [JT2, ***, port] , θ [JT3, ***, port] , L X1 , L X2 , L H Forward transformation coordinates in the X direction by (length of the substrate holding hand (20))

[0146] X' : θL[JT1, ***, port] , θ L[JT2, ***, port] , θ L[JT3, ***, port] , L' X1 , L' X2 , L H Forward transformation coordinates in the X direction by

[0147] Y : θ [JT1, ***, port] , θ [JT2, ***, port] , θ [JT3, ***, port] , L X1 , L X2 , L H Forward transformation coordinates in the Y direction by

[0148] Y' : θ L[JT1, ***, port] , θ L[JT2, ***, port] , θ L[JT3, ***, port] , L' X1 , L' X2 , L H Forward transformation coordinates in the Y direction by

[0149] am.

[0150] Also, X off[port] and Y off[port] The parts indicated by tip and root represent the amount of correction for the effect caused by thermal expansion, which is included in the amount of correction for the positional misalignment in the substrate holding hand (20) of the substrate (W). Also, X off[port] and Y off[port] Among them, the part indicated by teach represents the amount of correction for the influence caused by thermal expansion at the target position. For this reason, the control unit (30) X off[port] and Y off[port] Based on this, the effect caused by thermal expansion at the target position and the effect caused by thermal expansion included in the correction amount of the positional misalignment at the substrate holding hand (20) of the substrate (W) can be corrected.

[0151] Also, if there is no need to correct the positional misalignment of the substrate (W) in the substrate holding hand (20), X off[port] and Y off[port] Among them, the parts represented by tip and root do not need to be calculated. In this case, X off[port] and Yoff[port] In this case, only the part indicated by 'teach' is acquired, and the effect caused by thermal expansion at the target position is corrected. In cases where there is no need to consider the positional misalignment of the substrate (W) at the substrate holding hand (20), such as when the substrate holding hand (20) is a hand other than a passive hand, the correction can be made in this way.

[0152] Referring to FIG. 7, the correction processing of the effect of thermal expansion by the robot (100) of the present embodiment is explained based on a flowchart.

[0153] In step S101, the temperature of the robot arm (10) is detected by the temperature sensor (50), and the detection result of the temperature sensor (50) is obtained by the control unit (30). Then, in step S102, based on the detection result of the temperature sensor (50), the amount of correction for the influence of thermal expansion is obtained by the control unit (30). That is, based on the above equations (1) to (15), X by the control unit (30). off[port] and Y off[port] is obtained. Then, in step S103, the effect of thermal expansion is corrected by the control unit (30) based on the amount of correction for the effect of thermal expansion. That is, X off[port] and Y off[port] a. The effect of thermal expansion is corrected by the control unit (30) by adding the positional misalignment of the substrate holding hand (20) of the substrate (W) to the corrected target position.

[0154] [Effects of the present embodiment]

[0155] In this embodiment, as described above, the robot (100) includes a robot arm (10), a gear (431), and a shaft (44), and is equipped with a driving mechanism (40) for driving the robot arm (10), a temperature sensor (50) for detecting the temperature of the robot arm (10), and a control unit (30) for correcting the effect caused by thermal expansion between the robot arm (10), the gear (431), and the shaft (44) based on the detection result of the temperature sensor (50).

[0156] In addition, in this embodiment, as described above, the control method of the robot (100) comprises driving the robot arm (10) by a driving mechanism (40) including a gear (431) and a shaft (44), detecting the temperature of the robot arm (10) by a temperature sensor (50), and correcting the effect caused by thermal expansion between the robot arm (10), the gear (431), and the shaft (44) based on the detection result of the temperature sensor (50).

[0157] Thus, not only the effects caused by thermal expansion of the robot arm (10), but also the effects caused by thermal expansion of the gear (431) and shaft (44) can be corrected. As a result, compared to the case where only the effects caused by thermal expansion of the robot arm (10) are corrected, stable positioning accuracy with respect to temperature changes can be secured.

[0158] In addition, in this embodiment, as described above, the control unit (30) corrects the amount of rotational misalignment of the robot arm (10) caused by changes in backlash between gears (431) due to thermal expansion and a decrease in torsional rigidity of the shaft (44) due to thermal expansion. By doing so, even when a amount of rotational misalignment of the robot arm (10) occurs due to changes in backlash between gears (431) due to thermal expansion and a decrease in torsional rigidity of the shaft (44) due to thermal expansion, the amount of rotational misalignment of the robot arm (10) is corrected, thereby easily securing stable positioning accuracy against temperature changes.

[0159] In addition, in this embodiment, as described above, the control unit (30) corrects the effect of backlash between gears (431) caused by thermal expansion based on the detection result of the temperature sensor (50) and the thermal expansion coefficient between the robot arm (10) and the gear (431). Thus, even when the backlash between gears (431) changes due to the difference in the degree of thermal expansion between the robot arm (10) and the gear (431), the effect of backlash between gears (431) caused by thermal expansion can be easily corrected.

[0160] In addition, in this embodiment, as described above, the robot arm (10) and the gear (431) are formed from materials with different coefficients of thermal expansion. The control unit (30) corrects the effect of backlash between the gears (431) caused by thermal expansion based on the detection result of the temperature sensor (50) and the difference in the coefficients of thermal expansion between the robot arm (10) and the gear (431). Thus, in cases where the backlash between the gears (431) is prone to change because the degree of thermal expansion between the robot arm (10) and the gear (431) is prone to change due to the difference in the coefficients of thermal expansion between the robot arm (10) and the gear (431), the effect of backlash between the gears (431) caused by thermal expansion can be easily corrected.

[0161] In addition, in this embodiment, as described above, the gear (431) has an output gear (431a) and a plurality of input gears (431b, 431c). The control unit (30) corrects the effect of backlash caused by thermal expansion between the output gear (431a) and the input gear (431b) on the side of the output gear (431a) among the plurality of input gears (431b, 431c). By doing so, the effect of backlash caused by thermal expansion between the output gear (431a), which has a large amount of backlash change, and the input gear (431b) on the side of the output gear (431a) can be corrected, and thus the effect of backlash caused by thermal expansion can be effectively corrected.

[0162] In addition, in this embodiment, as described above, the control unit (30) corrects the effect of the decrease in torsional rigidity of the shaft (44) caused by thermal expansion based on the detection result of the temperature sensor (50) and the operating torque of the driving mechanism (40). By doing so, the effect of the decrease in torsional rigidity of the shaft (44) caused by thermal expansion can be easily corrected by taking into account the decrease in torsional rigidity of the shaft (44) caused by temperature and the deformation of the shaft (44) caused by the operating torque of the driving mechanism (40).

[0163] In addition, in this embodiment, as described above, the robot (100) is equipped with a substrate holding hand (20) positioned at the tip of the robot arm (10). By doing so, in a robot (100) that transports a substrate by the substrate holding hand (20), where relatively high positioning precision is required, stable positioning precision can be secured with respect to temperature changes.

[0164] In addition, in this embodiment, as described above, the robot (100) is placed in a clean room (200). Thus, in the case of the robot (100) placed in the clean room (200) where many repetitive operations are performed, stable positioning accuracy can be secured with respect to temperature changes. That is, stable repeatability accuracy can be secured with respect to temperature changes.

[0165] In addition, in this embodiment, as described above, the robot (100) is placed in a vacuum environment. Thus, in a robot (100) used in a vacuum environment where heat dissipation is difficult and temperature rise is likely to occur, the effect caused by thermal expansion can be compensated, thereby effectively securing stable positioning accuracy with respect to temperature changes.

[0166] In addition, in this embodiment, as described above, the shaft portion (44) includes a pivot shaft (441) and a bearing (442) into which the pivot shaft (441) is inserted. By doing so, the effect caused by thermal expansion of the shaft portion (44) including the pivot shaft (441) and the bearing (442) can be corrected.

[0167] [Variation Example]

[0168] Furthermore, the embodiments disclosed herein should be considered as illustrative and not limiting in all respects. The scope of this disclosure is defined by the claims, not by the description of the embodiments described above, and includes all modifications (variations) within the meaning and scope equivalent to the claims.

[0169] For example, in the above embodiment, an example was shown in which the robot arm is a horizontal multi-joint robot arm, but the present disclosure is not limited thereto. The robot arm may be a vertical multi-joint robot arm.

[0170] In addition, although the above embodiment shows an example in which one substrate holding hand is disposed at the tip of the robot arm, the present disclosure is not limited thereto. Two or more substrate holding hands may be disposed at the tip of the robot arm. In addition, hands other than the substrate holding hand may be disposed at the tip of the robot arm.

[0171] In addition, although the above embodiment shows an example where the substrate holding hand is a passive hand, the present disclosure is not limited thereto. The substrate holding hand may be a hand other than a passive hand.

[0172] In addition, although the above embodiments show an example where the robot is placed in a clean room, the present disclosure is not limited thereto. The robot may be placed outside of a clean room.

[0173] In addition, although the above embodiments have shown examples of vacuum robots deployed in a vacuum environment, the present disclosure is not limited thereto. The robot may also be an atmospheric robot deployed in an atmospheric environment.

[0174] In addition, in the above embodiment, an example was shown in which the control unit corrects the effect caused by thermal expansion between the robot arm and the gear and shaft based on the detection result of the temperature sensor, but the present disclosure is not limited thereto. The control unit may correct the effect caused by thermal expansion between the robot arm and at least one of the gear and shaft based on the detection result of the temperature sensor.

[0175] In addition, although the above embodiment illustrates an example in which the power transmission unit is a gear power transmission unit including a gear, the present disclosure is not limited thereto. The power transmission unit may also be a belt pulley power transmission unit including a pulley and a belt wound around the pulley. Even in this case, since the belt itself may expand due to thermal expansion, or the belt may expand as the distance between pulleys widens due to the thermal expansion of the robot arm, it is necessary to compensate for the effects caused by thermal expansion. The control unit can compensate for the effects caused by thermal expansion of the belt pulley power transmission unit, for example, based on the detection result of a temperature sensor and the thermal expansion coefficients of the robot arm, belt, and pulley.

[0176] Furthermore, although the above embodiment illustrates an example where the temperature sensor is a thermocouple disposed on the inner surface of the robot arm, the present disclosure is not limited thereto. The temperature sensor may be disposed outside the inner surface of the robot arm and may be something other than a thermocouple. For example, the temperature sensor may be a temperature sensor formed in the encoder of the motor of the driving mechanism.

[0177] Furthermore, in the above embodiment, the robot arm and the gear are formed from materials with different coefficients of thermal expansion, and the control unit corrects the effect of backlash between gears caused by thermal expansion based on the detection result of a temperature sensor and the difference in the coefficients of thermal expansion between the robot arm and the gear; however, the present disclosure is not limited thereto. The robot arm and the gear may be formed from materials with the same coefficient of thermal expansion. Even in this case, if the heat distribution in the robot arm and the gear is different, there is a risk that the angular error described in the above embodiment may occur because the amount of thermal expansion in the robot arm and the gear is different. In this case, the temperatures of the robot arm and the gear are detected separately, and the effect of backlash between gears caused by thermal expansion can be corrected based on the temperature detection result of the robot arm, the temperature detection result of the gear, the coefficient of thermal expansion of the robot arm, and the coefficient of thermal expansion of the gear.

[0178] Additionally, although the above embodiments illustrate examples in which the robot arm is formed of aluminum and the gear is formed of iron, the present disclosure is not limited thereto. The robot arm and the gear may be formed of any material.

[0179] In addition, although the above embodiment shows an example in which the gear has an output gear and a plurality of input gears, the present disclosure is not limited thereto. The gear may have an output gear and a single input gear.

[0180] In addition, in the above embodiment, an example was shown in which the control unit corrects the effect caused by thermal expansion of backlash between the output gear and the input gear closest to the output gear among the plurality of input gears, but the present disclosure is not limited thereto. The control unit may correct not only the backlash between the output gear and the input gear, but also the effect caused by thermal expansion of backlash between input gears.

[0181] The function of an element disclosed herein may be executed using a circuit or processing circuit comprising a general-purpose processor, a dedicated processor, an integrated circuit, an ASIC (Application Specific Integrated Circuit), a conventional circuit, and / or a combination thereof, configured or programmed to execute the disclosed function. A processor is considered a processing circuit or circuit because it includes transistors or other circuits. In this disclosure, a circuit, unit, or means is hardware that executes the enumerated function or is hardware programmed to execute the enumerated function. The hardware may be the hardware disclosed herein or other known hardware that is programmed or configured to execute the enumerated function. Where the hardware is a processor considered to be a type of circuit, the circuit, means, or unit is a combination of hardware and software, and the software is used in the configuration of the hardware and / or processor. Explanation of the symbols

[0182] 10: Robot Arm 20: Substrate holding hand 30 : Control unit 40: Driving mechanism 43: Power transmission unit 44 : Shrine 50: Temperature sensor 100 : Robot 200: Clean Room 431 : Gear 431a: Output gear 431b, 431c: Input gear 441 : Rotation axis 442 : Bearing

Claims

Claim 1 A robot comprising a robot arm, a gear and a shaft, a driving mechanism for driving the robot arm, a temperature sensor for detecting the temperature of the robot arm, and a control unit for correcting the effect caused by thermal expansion between at least one of the robot arm, the gear and the shaft based on the detection result of the temperature sensor, wherein the control unit corrects the effect caused by thermal expansion of backlash between the gears based on the detection result of the temperature sensor and the coefficient of thermal expansion between the robot arm and the gear. Claim 2 A robot according to claim 1, wherein the control unit corrects the amount of rotational misalignment of the robot arm caused by at least one of a change in backlash between the gears caused by thermal expansion and a decrease in torsional rigidity of the shaft part caused by thermal expansion. Claim 3 delete Claim 4 A robot according to claim 1, wherein the robot arm and the gear are formed of materials having different coefficients of thermal expansion, and the control unit corrects the effect of backlash between the gears caused by thermal expansion based on the detection result of the temperature sensor and the difference in coefficients of thermal expansion between the robot arm and the gear. Claim 5 A robot according to claim 1, wherein the gear has an output gear and a plurality of input gears, and the control unit corrects the effect caused by thermal expansion of backlash between the output gear and the input gear closest to the output gear among the plurality of input gears. Claim 6 A robot according to claim 1, wherein the control unit corrects the effect of the reduction in torsional stiffness of the shaft portion caused by thermal expansion based on the detection result of the temperature sensor and the operating torque of the driving mechanism. Claim 7 A robot according to claim 1, further comprising a substrate holding hand disposed at the tip of the robot arm. Claim 8 A robot placed in a clean room in claim 1. Claim 9 A robot according to claim 1, placed in a vacuum environment. Claim 10 A robot according to claim 1, wherein the shaft portion comprises a pivot shaft and a bearing into which the pivot shaft is inserted. Claim 11 A robot comprising a robot arm, a power transmission unit, and a shaft unit, a driving mechanism for driving the robot arm, a temperature sensor for detecting the temperature of the robot arm, and a control unit for correcting the effect caused by thermal expansion between at least one of the robot arm, the power transmission unit, and the shaft unit based on the detection result of the temperature sensor, wherein the control unit corrects the effect caused by thermal expansion of backlash between the power transmission units based on the detection result of the temperature sensor and the thermal expansion coefficient between the robot arm and the power transmission unit. Claim 12 A method for controlling a robot, comprising driving a robot arm by a driving mechanism including a gear and a shaft, detecting the temperature of the robot arm by a temperature sensor, and correcting an effect caused by thermal expansion between the robot arm and at least one of the gear and the shaft based on the detection result of the temperature sensor, wherein the correction of the effect caused by thermal expansion includes correcting an effect caused by thermal expansion of backlash between the gears based on the detection result of the temperature sensor and the thermal expansion coefficient between the robot arm and the gear. Claim 13 A control method for a robot according to claim 12, wherein correcting the effect caused by thermal expansion includes correcting the amount of rotational misalignment of the robot arm caused by at least one of a change in backlash between the gears caused by thermal expansion and a decrease in torsional rigidity of the shaft part caused by thermal expansion.

Citation Information

Patent Citations

  • Scalar robot for carrying flat plate-like object and processing system for flat plate-like object

    JP2003170384A

  • Industrial robot and control method of industrial robot

    KR1020210010331A

  • Robot Adaptive Placement System with End-Effector Position Estimation

    US20160136812A1

  • Positioning system using robot

    US20170274534A1