資源簡介
三維定位chan_taylor,針對數學建模設計,matlab代碼。簡單修改參數可直接使用,注釋清晰

代碼片段和文件信息
function?[xyz]=chan_taylor(x0y0z0)
X=[0?-15?0?15];
Y=[0?15?15?15];
Z=[0?10?10?10];
BS=[X;Y;Z;];
x0=input(‘x0=‘);y0=input(‘y0=‘);z0=input(‘z0=‘);
test=[x0;y0;z0];
disp(‘基站坐標‘);disp(BS);
disp(‘假設目標坐標‘);disp(test);
figure(1)
plot3(XYZ‘rp‘x0y0z0‘g*‘);
text(X(1)Y(1)Z(1)‘BS1‘);text(X(2)Y(2)Z(2)‘BS2‘);text(X(3)Y(3)Z(3)‘BS3‘);text(X(4)Y(4)Z(4)‘BS4‘)
text(x0y0z0‘假設目標‘);
xlabel(‘x軸‘);ylabel(‘y軸‘);zlabel(‘z軸‘);
grid?on;
axis([-30?30?-30?30?-30?30]);
box;
for?i=1:4
????r=sqrt((X-x0).^2+(Y-y0).^2+(Z-z0).^2);
????k=sqrt(X.^2+Y.^2+Z.^2);
end
disp(‘目標到基站距離r‘);disp(r);
disp(‘基站到原點距離k‘);disp(k);
for?i=2:4
????H(i-1)=(k(i).^2-k(1).^2-(r(i)-r(1)).^2)/2;
????G((i-1)1)=X(i)-X(1);G((i-1)2)=Y(i)-Y(1);G((i-1)3)=Z(i)-Z(1);G((i-1)4)=r(i)-r(1);
end
disp(H‘);disp(G);
target=G\H‘;
disp(target);
hold?on;
plot3(target(1)target(2)target(3)‘ms‘);
?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----
?????文件?????????921??2013-01-09?11:12??chan_taylor.m
- 上一篇:二維圖像分形維數計算
- 下一篇:L1范數最小化matlab源代碼
評論
共有 條評論