%Chan定位算法

function?[admse_Chan3]=Chan（X1Y1X2Y2X3Y3X4Y4X5Y5X6Y6X7Y7）
C?=?300000000;?%?光速（米每秒）
R?=?1000;??????%?小區半徑（米）
Rn?=?R/1000;???%（km）
x_delta?=?0;
y_delta?=?0;
e?=?0;
%?stda?=?0.01;
%?蜂窩系統各基站坐標
X1?=?0;
Y1?=?0;
X2?=?R*（1+sqrt（3）/2）;
Y2?=?0;
X3?=?R*（sqrt（3）/2）;
Y3?=?R*（-3/2）;
X4?=?R*（-sqrt（3）/2）;
Y4?=?R*（-3/2）;
X5?=?R*（-1-（sqrt（3）/2））;
Y5?=?0;
X6?=?R*（-sqrt（3）/2）;
Y6?=?R*（3/2）;
X7?=?R*（sqrt（3）/2）;
Y7?=?R*（3/2）;

%?KM?=?XM^2?+?YM^2
K1?=?Ka（X1Y1）;
K2?=?Ka（X2Y2）;
K3?=?Ka（X3Y3）;
K4?=?Ka（X4Y4）;
K5?=?Ka（X5Y5）;
K6?=?Ka（X6Y6）;
K7?=?Ka（X7Y7）;
%?XM_1?=?XM?-?X1；YM_1?=?YM?-?X1
????X2_1?=?Xab（X2X1）;
????Y2_1?=?Xab（Y2Y1）;
????X3_1?=?Xab（X3X1）;
????Y3_1?=?Xab（Y3Y1）;
????X4_1?=?Xab（X4X1）;
????Y4_1?=?Xab（Y4Y1）;
????X5_1?=?Xab（X5X1）;
????Y5_1?=?Xab（Y5Y1）;
????X6_1?=?Xab（X6X1）;
????Y6_1?=?Xab（Y6Y1）;
????X7_1?=?Xab（X7X1）;
????Y7_1?=?Xab（Y7Y1）;
%?隨機產生MS的位置（x，y）
?u?=?rand（1）;
?y?=?（R/2）*（1-sqrt（u））;
?v?=?（sqrt（3）*（（R/2）-y））*rand（1）;
?x?=?sqrt（3）*y?+?v;
%?x?=?300;
%?y?=?800;
%?計算MS到各基站的距離
R1?=?distance（X1Y1xy）;
R2?=?distance（X2Y2xy）;
R3?=?distance（X3Y3xy）;
R4?=?distance（X4Y4xy）;
R5?=?distance（X5Y5xy）;
R6?=?distance（X6Y6xy）;
R7?=?distance（X7Y7xy）;

num?=?5;
PPP=1000;
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%?Chan算法
????for?i?=?1:num
????????sgma?=?i*30;
????????for?ss?=?1:PPP
????????????%?RM_1為帶誤差的距離差
????????????R2_1?=?Rab（R2R1）?+?gngauss（sgma）;
????????????T2_1（ss）?=?R2_1/C;
????????????R3_1?=?Rab（R3R1）?+?gngauss（sgma）;
????????????T3_1（ss）?=?R3_1/C;
????????????R4_1?=?Rab（R4R1）?+?gngauss（sgma）;
????????????T4_1（ss）?=?R4_1/C;
????????????R5_1?=?Rab（R5R1）?+?gngauss（sgma）;
????????????T5_1（ss）?=?R5_1/C;
????????????R6_1?=?Rab（R6R1）?+?gngauss（sgma）;
????????????T6_1（ss）?=?R6_1/C;
????????????R7_1?=?Rab（R7R1）?+?gngauss（sgma）;
????????????T7_1（ss）?=?R7_1/C;
????????end
????????%?各TDOA測量值的方差
????????T2_1_fangcha?=?var（T2_1）;
????????T3_1_fangcha?=?var（T3_1）;
????????T4_1_fangcha?=?var（T4_1）;
????????T5_1_fangcha?=?var（T5_1）;
????????T6_1_fangcha?=?var（T6_1）;
????????T7_1_fangcha?=?var（T7_1）;?
????????
????????for?k?=?1:PPP
????????????%?假設MS到BSi的距離與MS到BS1的距離差為：R2_1=Ri-R1產生的