Altimeter Working

Altimeter is working using code from forum post, back to where it was a
few days ago. Need to improve altimeter code performance.