Constrained motion control of a 5-axis manipulator for the finishing application