Research on Trajectory Planning and Motion Control of 7-DoF Sawyer Manipulator

Abstract

Regarding human-machine collaborative task, generated trajectories of a robot manipulator should be able to avoid joint limits and singularities, but the 6 Degrees of Freedom(DoF) or lower DoF manipulators encounter difficulties in many schemes. In this paper, research is implemented on the methods of trajectory planning and motion control on the newly human-machine collaborative 7-DoF Sawyer manipulator. We try to pay more attention to these approaches and find a better combination between trajectory planners and motion controllers for Sawyer manipulator. First of all, comparison is proposed between the methods about trajectory planning in task space and joint space, drawing a conclusion that the latter has the advantage of quickness and smoothness on trajectories in real time. Next, we choose to plan trajectory in the joint space by interpolating positions and orientations. Three approaches, i.e., trapezoidal velocity trajectory, cubic polynomial trajectory and basic spline trajectory, are applied to interpolate positions. Experimental results show that it results in the smoothest trajectory using basic spline trajectory planning. We also compare linear and nonlinear orientation interpolations to address the angle wrapping issue, which leads to difficulties in smooth orientation interpolation between several waypoints. Combining polynomial trajectory planning methods with the proportional-derivative (PD) motion controller and the computed-torque motion controller, we focus on the performance of the two different combinations. It is found that trajectories with computed-torque controller have shorter path with a congruous convergence on joint position, and more accurate trajectories with less overshoots in position than others.