Tuned PID controller and slowed down the task space interpolation