%**********************基于TDOA的Chan算法**********************************
%??function?[MS]=chan（M）?????%%%%%%%%%%%%%%%
%假設移動臺坐標為
M=4;????????????????????????%%%%%%%%%%%%%%%
ms=[5001000];
x=ms（1）;y=ms（2）;%移動臺真實位置
c=3*10^8;%信號傳播速度

X=[00-4500-45000450045004500-4500-9000-450045009000];
Y=[051962598-2598-5916-25982598779477940-7794-77940];
%假設小區半徑是3000m.XY分別是基站位置橫縱坐標
basestx=X（1:M）;
basesty=Y（1:M）;?%M是參與定位的基站數目M的取值最大是13.
N=length（basestx）;?%參與定位的基站數目

Standarddeviation=[30405060708090100110120];?%測量誤差標準差?/m


ri1=[];?%第i（i>=2）個基站到移動臺距離與第一個基站的（服務基站）到移動臺距離的差值。
xi1=[];?%第i個基站與第一個基站位置橫坐標的差值
yi1=[];?%第i個基站與第一個基站位置縱坐標的差值
k=[];
h=[];
Ga=[];

for?i=2:N
?????xi1（i-1）=basestx（i）-basestx（1）;
?????yi1（i-1）=basesty（i）-basesty（1）;
end??%對xi1yi1進行賦值
???
for?i=1:N
????k（i）=（basestx（i））^2+（basesty（i））^2;
end??%對k進行賦值

rmse=[];
for?j0=1:length（Standarddeviation）
?
???for?i=2:N
???????ri1（i-1）=sqrt（（basestx（i）-x）^2+（basesty（i）-y）^2）-?sqrt（（basestx（1）-x）^2+（basesty（1）-y）^2）-Standarddeviation（j0）;
?????%在測量參數不知道的情況下為方便仿真，假設移動臺位置已知，
?????%則可以知道各個基站與移動臺的實際距離差。
?????%由于測量有誤差，這里用實際距離差加上或減去測量誤差標準差來表示測到的距離差
???end

???for?i=2:N
????????h（i-1）=0.5*（（ri1（i-1））^2-k（i）+k（1））;
???end??%對h進行賦值

???for?i=1:3
???????for?j=2:N
???????????switch?i
??????????????????case?1
????????????????????????Ga（j-1i）=-xi1（j-1