Mode switch

Motors reset to 0 on mode switch for safety. Initial orientation sets
itself every time mode is set to sensors.