Tuned Joint Limits to get rid of Trajectory timed out errors
Removed is_trajectory_finished check