資源簡(jiǎn)介
很好用的時(shí)差定位GDOP仿真程序,適合初學(xué)者使用。
代碼片段和文件信息
%雙站交叉定位誤差展示程序
function[PM]=DOA(X1Y1e1X2Y2e2XdRTVt)
%%?設(shè)置觀(guān)測(cè)站分布
%主站位于坐標(biāo)原點(diǎn),單位:km
x1=10;
y1=10;
x2=-10;
y2=10;
XI=[x1x2];
YI=[y1y2];
%產(chǎn)生觀(guān)測(cè)數(shù)據(jù)
%假設(shè)被定位對(duì)象勻速地從A點(diǎn)(dx1dy1)運(yùn)動(dòng)到B點(diǎn)(dx2dy2),單位:km
%使用速度輸入V(km/h),則dx2=V*t,t為觀(guān)測(cè)時(shí)長(zhǎng)(h)
%dy1=dy2=R,目標(biāo)距離
%假設(shè)采樣時(shí)間間隔為1h
Px=[Xd:V*T:V*t]‘;
[nd]=size(Px);
Py=ones(n1);
Py=Py*R;
P(:1)=Px;
P(:2)=Py;
%根據(jù)觀(guān)測(cè)誤差水平,生成各個(gè)觀(guān)測(cè)位置的觀(guān)測(cè)值(含誤差)
for?i=1:n
????%第一站方位角
????a1(i)=atand((Py(i)-y1)/(Px(i)-x1));
????if?a1(i)<0
???????a1(i)=180-abs(a1(i));
????end
????%第二站方位角
????a2(i)=atand((Py(i)-y2)/(Px(i)-x2));
????if?a2(i)<0
???????a2(i)=180-abs(a2(i));
????end
????%求定位模糊區(qū)半徑
????r1(i)=R/sind(a1(i));%第一站目標(biāo)距離
????R1(i)=sind(e1)*r1(i);%第一站誤差半徑?
????r2(i)=R/sind(a2(i));%第二站目標(biāo)距離
????R2(i)=sind(e2)*r2(i);%第二站誤差半徑?
???
????if?R1(i)>R2(i)
???????Re(i)=R2(i);
????else
???????Re(i)=R1(i);
評(píng)論
共有 條評(píng)論