Added altimeter sampling speed experiment and tweaked IMU code to handle initialization errors