Iterative altitude-aiding algorithm for improved GNSS positioning