Altimeter Working Good

Altimeter is now updating quickly and correctly. There is a bit of
noise/drift, but I don't think this can be improved.