Control device for substrate transfer robot and control method for joint motor

A control device of a substrate transfer robot, the substrate transfer robot comprising:

• a hand capable of holding a substrate;
• a joint whose axis is oriented in a vertical direction;
• and
• a joint motor that drives the joint, wherein
• the control device modifies a target position of the hand when the substrate is placed at a transfer destination, based on positional misalignment information indicating misalignment of the substrate held by the hand,
• to change a position at which the hand places the substrate to the target position after the modification, the control device adds a velocity correction function, being a time function of a velocity correction value, to velocity of the hand,
• the velocity correction function includes:
• a first period during which the velocity correction value is zero at a start time point of correcting and increases linearly from zero as time elapses;
• and
• a second period during which the velocity correction value decreases linearly from the velocity correction value at an end time point of the first period to zero at an end time point of the correcting as time elapses,
• the end time point of the correcting is simultaneous with a time point at which the velocity of the hand before the correcting reaches zero, and
• a slope of the velocity increasing in the first period becomes steeper and a slope of the velocity decreasing in the second period becomes steeper as a magnitude of change in the target position due to the modification increases.

A control method of a joint motor of a substrate transfer robot, the substrate transfer robot comprising:

• a hand capable of holding a substrate;
• a joint whose axis is oriented in a vertical direction;
• and
• the joint motor that drives the joint, wherein
• a target position of the hand when the substrate is placed at a transfer destination is modified based on positional misalignment information indicating misalignment of the substrate held by the hand,
• to change a position at which the hand places the substrate to the target position after the modification:
• first velocity control to make velocity of the hand that is approaching the target position before the modification with the velocity decreasing constant by correcting;
• and
• second velocity control to make the velocity of the hand decrease by a slope equal to a slope of the velocity of the hand immediately before the first velocity control and to stop the hand at the target position after the modification,
• are performed, and
• time during which the first velocity control is performed increases as a magnitude of change in the target position due to the modification increases.

A control method of a joint motor of a substrate transfer robot, the substrate transfer robot comprising:

• a hand capable of holding a substrate;
• a joint whose axis is oriented in a vertical direction;
• and
• the joint motor that drives the joint, wherein
• a target position of the hand when the substrate is placed at a transfer destination is modified based on positional misalignment information indicating misalignment of the substrate held by the hand,
• to change the position at which the hand places the substrate to the target position after the modification, a velocity correction function, being a time function of a velocity correction value, is added to velocity of the hand,
• the velocity correction function includes:
• a first period during which the velocity correction value is zero at a start time point of correcting and increases linearly from zero as time elapses;
• and
• a second period during which the velocity correction value decreases linearly from the velocity correction value at an end time point of the first period to zero at an end time point of the correcting as time elapses,
• the end time point of the correcting is simultaneous with a time point at which the velocity of the hand before the correcting reaches zero, and
• a slope of the velocity increasing in the first period becomes steeper and a slope of the velocity decreasing in the second period becomes steeper as a magnitude of change in the target position due to the modification becomes larger.