A Probabilistic Approach to Detect and Mitigate GNSS NLOS Using State Augmented Kalman Filter