Optimized Altimeter library and updated compass library