Fix issue #1 - Altitude incorrect

remove crap altitude calculation and add a better in a function
Merge branch 'v0.02'
Updated a minor comment

note that p0 really need to be the current calculated mslp
Merge branch 'v0.02'
Update to test
Merge branch 'v0.02'