Added new DiveTo state for absolute depth; Dive now does relative depth.
Merge remote-tracking branch 'schristian/vehicle_refactor_2014' into vehicle_refactor_2014
important fix to utility
Merge remote branch 'eliot/vehicle_refactor_2014' into vehicle_refactor_2014
fixed drift issue