A New Local Planner

Implementing the graceful_controller package.