Added sensing package and fixed a small issue in ramp_planner
The sensing package will take in all the sensor data and publish information about the environment. For now, we will have an extremely basic version. The sensing package will take in the infrared sensor and publish the object location and size. The evaluation package will subscribe to this information so paths can be labelled as feasible/infeasible
In ramp_planner, the modification procedure was re-evaluating ALL trajectories, rather than just the new trajectories. That is fixed and should make things faster.
TODO: Finish the sensing package publishing info. Make a new msg?
TODO: Clean evaluation and make it subscribe to sensing info, and run collision detection