连续法相对定向

clc
clear
tic
%-----------initialize------
f=153.124/1000;
x_0=-0.002/1000;y_0=0.002/1000;
image_1=[-25.1960000000000-94.0773000000000;-6.9443000000000060.8659000000000;9.3021000000000062.4007000000000;79.060500000000059.1308000000000;12.481000000000037.3720000000000;76.879100000000028.9323000000000;11.122700000000019.0341000000000;55.895600000000014.1632000000000;86.975500000000014.3368000000000;101.02040000000013.6838000000000;-10.7387000000000-8.71440000000000;35.0030000000000-6.85920000000000;77.2341000000000-10.8843000000000;33.0724000000000-30.4913000000000;56.7053000000000-30.3289000000000;10.3672000000000-59.7328000000000;36.3343000000000-59.0140000000000;51.9777000000000-64.2110000000000;80.0891000000000-60.5609000000000;10.6496000000000-74.0084000000000];
imag