Workspace simulation and trajectory planning of food handling robot

Abstract

Objective: Analyzed the workspace of 6-DOF food handling robot and planed the motion trajectory, so as to provide basis for the layout of food handling platform in workstation and the motion control of robot. Methods: Composition and structure of the robot were analyzed, the kinematics model was established, and the kinematics model was verified by MATLAB. Based on this, the workspace of the robot was modeled and solved, the working area of the robot was obtained, and the reasonable layout position of the food handling table was given; combined with the requirements of food handling task, a three-stage quintic polynomial interpolation method was proposed for robot end trajectory planning. The effectiveness of this method was verified by MATLAB simulation and experiment. Results: The reasonable layout space of the food handling table was the area of z＞0 mm and 200 mm＜r＜500 mm. The method of three-stage quintic polynomial trajectory planning can make the robot perform the food handling task smoothly, and increase the accurate control of the point position, speed and acceleration of the robot. Conclusion: The method of three-stage quintic polynomial trajectory planning is effective for the robot to perform the food handling task.

Keywords

• food
• handling robot
• kinematics
• workspace
• trajectory planning