Calculates position based on the CDGPS algorithm