Calculates position based on the CDGPS algorithm in MATLAB - View it on GitHub