[GNSS/nav] lambda_fi71: Function added. Not verified working yet.
[GNSS/nav] lambda_fi71: Working. Output verified with MATLAB output.

Need to create a test to ensure this algorithm works well.