Algorithm 1.

1:  Initialization Parameters:   Signal transmitting base station coordinates;

Ground calibration point coordinates;

Ground test point coordinates;

Initial phase calibration: $\Delta {\varphi }_{i,L_1}$ , $\Delta {\varphi }_{i,B_1}$

2:  while $\varphi$ not empty do

3:   Group by frequency characteristics $D\leftarrow GroupbyFre()$;

4:   Cycle count to distance conversion $\mathbf{\Phi }\leftarrow \lambda \varphi$;

5:   Get the distance difference between frequencies $diff(\mathbf{\Phi })$;

6:   Phase accumulation span detection:

if$\Delta \Phi <diff(\mathbf{\lambda })$

$(\mathbf{n},index)=cycle\_n\_\mathrm{mod}\mathrm{i}(cn0,doppler,position,\mathbf{\Phi },indx)$;

else

$\mathbf{n}=0$;

end

7:    Calculate the whole cycles $\mathbf{N}$:

$\mathbf{N}=calN(\Delta \mathsf{\phi },\Delta {\mathsf{\phi }}_i,\mathbf{\lambda })$

8:    Calculate the distance $\mathsf{\rho }$

$\mathsf{\rho }=calP(\Delta \mathsf{\phi },\Delta {\mathsf{\phi }}_i,\mathbf{\lambda },\mathbf{n},index)$;

9:  end while