Fixed distance based constraint on Task.
Merge branch 'vehicle_refactor_2014' of https://github.com/robotics-at-maryland/tortuga into vehicle_refactor_2014
sonar navigation only centers for now
Merge branch 'vehicle_refactor_2014' of https://github.com/robotics-at-maryland/tortuga into vehicle_refactor_2014