Added altimeter sensor fusion