Re-enabled the altimeter code. Still needs testing.