JTraj for contours are not always executable
Sometimes the contour has multiple t=0 time stamps which makes them impossible ROS JointTrajectories.
-
if time stamp is same as previous and ik solutions is same as previous, remove the point since it doesn't add anything to the JTraj (implement in contour_trajs)