Update navigation algorithm in the helper app. Add altitude reading