In this paper, the trajectory planning method of a semiconductor wafer transfer three-joint robot arm driven with stepping motors by use of the genetic algorithm is proposed, and the experimental results are demonstrated to confirm the usefulness of the present trajectory planning method. The whole trajectory consists of three trajectory portions; a straight line trajectory portion to take out the semiconductor wafer, a curved line trajectory portion under PTP action, and a straight line trajectory portion to set the semiconductor wafer. In the trajectory planning, the three trajectory portions are expressed by polynomials, and, by using the continuous conditions concerning joint angles, joint angular velocities and joint angular accelerations, the whole trajectory is described by a chromosome consisting of five genes. Then, the fitness function of the genetic algorithm for the quasi minimum time control under the constraint condition that the stepping motor torques should not exceed pull-out torques is defined, and the trajectory planning algorithm is constructed. Furthermore, the numerical calculations have been carried out, and it is confirmed that the trajectory planning can be successfully executed. Additionally, from the experimental results, it is ascertained that the trajectory tracking control of the trajectory of the semiconductor wafer transfer robot can be exactly implemented.
[1]
Hartmut Weber.
A motion planning and execution system for mobile robots driven by stepping motors
,
2000,
Robotics Auton. Syst..
[2]
C. Lin,et al.
Formulation and optimization of cubic polynomial joint trajectories for industrial robots
,
1983
.
[3]
Bertrand Tondu,et al.
The Three-Cubic Method: An Optimal Online Robot Joint Trajectory Generator under Velocity, Acceleration, and Wandering Constraints
,
1999,
Int. J. Robotics Res..
[4]
Lianfang Tian,et al.
An effective robot trajectory planning method using a genetic algorithm
,
2004
.
[5]
Dimitri Knjazew,et al.
OmeGA - a competent genetic algorithm for solving permutation and scheduling problems
,
2002,
Genetic algorithms and evolutionary computation.
[6]
Eiji Shintaku.
Minimum energy trajectory for an underwater manipulator and its simple planning method by using a Genetic Algorithm
,
1998,
Adv. Robotics.