split up setup function to multitple functions for better logging. Added enable and disable features for compass and GPS