Added code to enable the robot to move along infeasible trajectory
If no trajectories are feasible, the robot should move along the best infeasible trajectory
Also, gave RampTrajectory class an ID field
Merge branch 'master' of https://github.com/sterlingm/ramp