Fixed distance based constraint on Task.
Merge branch 'vehicle_refactor_2014' of https://github.com/robotics-at-maryland/tortuga into vehicle_refactor_2014