Control method and control device for robot
When first arm is connected to a base at a joint point J 0 , a second arm is connected to the first arm at a joint point J 1 , a third arm is connected to the second arm at a joint point J 2 , a hand is connected to the third arm at a joint point J 3 , a target position of the joint point J 3 is designated, and a robot is moved, the joint point J 2 is set on a virtual travel axis passing through the joint point J 0 , an angle formed by a reference direction (X-axis) and the virtual travel axis is defined as a virtual travel axis angle, and respective motors of axes are driven using the virtual travel axis angle and the target position.
1 . A control method to control a horizontal articulated robot that transports a workpiece between a plurality of stages, the robot comprising a base, a first arm rotatably connected to the base, a second arm rotatably connected to the first arm, a third arm rotatably connected to the second arm, and a hand rotatably connected the third arm and holding the workpiece, the control method comprising
a driving step which comprising
defining, as an origin, a position at which the first arm is connected to the base,
defining, as a first joint point, a position at which the second arm is connected to the first arm, to define, as a second joint point, a position at which the third arm is connected to the second arm,
defining, as a third joint point, a position at which the hand is connected to the third arm,
setting the second joint point on a virtual travel axis passing through the origin in a horizontal plane when the robot is moved to the third joint point designated as a target position,
defining, as a virtual travel axis angle, an angle formed by a reference direction passing through the origin and horizontally extending and the virtual travel axis,
driving respective motors of axes by using the virtual travel axis angle and the target position, and to actually move the robot.
2 . The control method according to claim 1 , wherein
before the driving step is performed, optimum value calculation to calculate an optimal one of the virtual travel axis angle corresponding to the target position is performed.
3 . The control method according to claim 2 , wherein
the robot is operated by point-to-point operation in the driving step, and
the optimum value calculation is to calculate arrival time required to reach the target position when the robot is operated by the point-to-point operation while changing the virtual travel axis angle, and to obtain the optimum virtual travel axis angle on the basis of the virtual travel axis angle at which the arrival time is minimized.
4 . The control method according to claim 2 , wherein
the robot is operated by linear interpolation operation in the driving step, and
the optimum value calculation is to calculate maximum velocity when the robot is operated by the linear interpolation operation to reach the target position while changing the virtual travel axis angle, and to obtain the optimum virtual travel axis angle on the basis of the virtual travel axis angle at which the maximum velocity is maximized.
5 . The control method according to claim 1 , wherein
the reference direction is determined parallel to a direction in which the plurality of stages are arranged.
6 . The control method according to claim 2 , wherein
the reference direction is determined parallel to a direction in which the plurality of stages are arranged.
7 . The control method according to claim 3 , wherein
the reference direction is determined parallel to a direction in which the plurality of stages are arranged.
8 . The control method according to claim 4 , wherein
the reference direction is determined parallel to a direction in which the plurality of stages are arranged.
9 . The control method according to claim 1 , wherein
an effective length of the first arm is equal to an effective length of the second arm.
10 . The control method according to claim 2 , wherein
an effective length of the first arm is equal to an effective length of the second arm.
11 . The control method according to claim 3 , wherein
an effective length of the first arm is equal to an effective length of the second arm.
12 . The control method according to claim 4 , wherein
an effective length of the first arm is equal to an effective length of the second arm.
13 . The control method according to claim 1 , wherein
the first arm, the second arm, the third arm and the hand are folded, a posture in which the first joint point, the second joint point, and the third joint point are located on a straight line orthogonal to the reference direction passing through the origin in the horizontal plane is defined as an origin position, the origin position is defined as an initial position, and the robot is sequentially moved.
14 . The control method according to claim 2 , wherein
the first arm, the second arm, the third arm and the hand are folded, a posture in which the first joint point, the second joint point, and the third joint point are located on a straight line orthogonal to the reference direction passing through the origin in the horizontal plane is defined as an origin position, the origin position is defined as an initial position, and the robot is sequentially moved.
15 . The control method according to claim 3 , wherein
the first arm, the second arm, the third arm and the hand are folded, a posture in which the first joint point, the second joint point, and the third joint point are located on a straight line orthogonal to the reference direction passing through the origin in the horizontal plane is defined as an origin position, the origin position is defined as an initial position, and the robot is sequentially moved.
16 . The control method according to claim 4 , wherein
the first arm, the second arm, the third arm and the hand are folded, a posture in which the first joint point, the second joint point, and the third joint point are located on a straight line orthogonal to the reference direction passing through the origin in the horizontal plane is defined as an origin position, the origin position is defined as an initial position, and the robot is sequentially moved.
17 . A control device to control a horizontal articulated robot that comprises a base, a first arm rotatably connected to the base, a second arm rotatably connected to the first arm, a third arm rotatably connected to the second arm, and a hand rotatably connected the third arm and holding a workpiece, and transports the workpiece between a plurality of stages, wherein
a position at which the first arm is connected to the base is defined as an origin, a position at which the second arm is connected to the first arm is defined as a first joint point, a position at which the third arm is connected to the second arm is defined as a second joint point, a position at which the hand is connected to the third arm is defined as a third joint point, and
when the robot is moved to the third joint point designated as a target position, the second joint point is set on a virtual travel axis passing through the origin in a horizontal plane, an angle formed by a reference direction passing through the origin and horizontally extending and the virtual travel axis is defined as a virtual travel axis angle, and each motor of each axis is driven by using the virtual travel axis angle and the target position to make the robot actually moved.
18 . The control device according to claim 17 , wherein
a function, to obtain the virtual travel axis angle at which the arrival time is minimized, by calculating arrival time required to reach the target position while changing the virtual travel axis angle when the robot is operated by the point-to-point operation, is implemented.
19 . The control device according to claim 17 , wherein
a function, to calculate maximum velocity at a time of reaching the target position, by operating the robot by linear interpolation operation when the virtual travel axis angle is given, is implemented.