The time optimal trajectory planning with limitation of operating task for the Tokamak inspecting manipulator

In this paper, a new optimization model of time optimal trajectory planning with limitation of operating task for the Tokamak inspecting manipulator is designed. The task of this manipulator is to inspect the components of Tokamak, the inspecting velocity of manipulator must be limited in the operating space in order to get the clear pictures. With the limitation of joint velocity, acceleration and jerk, this optimization model can not only get the minimum working time along a specific path, but also ensure the imaging quality of camera through the constraint of inspecting velocity. The upper bound of the scanning speed is not a constant but changes according to the observation distance of camera in real time. The relation between scanning velocity and observation distance is estimated by curve-fitting. Experiment has been carried out to verify the feasibility of optimization model, moreover, the Laplace image sharpness evaluation method is adopted to evaluate the quality of images obtained by the proposed method.