資源簡介
很好用的時差定位GDOP仿真程序,適合初學者使用。
代碼片段和文件信息
%雙站交叉定位誤差展示程序
function[PM]=DOA(X1Y1e1X2Y2e2XdRTVt)
%%?設置觀測站分布
%主站位于坐標原點,單位:km
x1=10;
y1=10;
x2=-10;
y2=10;
XI=[x1x2];
YI=[y1y2];
%產生觀測數據
%假設被定位對象勻速地從A點(dx1dy1)運動到B點(dx2dy2),單位:km
%使用速度輸入V(km/h),則dx2=V*t,t為觀測時長(h)
%dy1=dy2=R,目標距離
%假設采樣時間間隔為1h
Px=[Xd:V*T:V*t]‘;
[nd]=size(Px);
Py=ones(n1);
Py=Py*R;
P(:1)=Px;
P(:2)=Py;
%根據觀測誤差水平,生成各個觀測位置的觀測值(含誤差)
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
????%求定位模糊區半徑
????r1(i)=R/sind(a1(i));%第一站目標距離
????R1(i)=sind(e1)*r1(i);%第一站誤差半徑?
????r2(i)=R/sind(a2(i));%第二站目標距離
????R2(i)=sind(e2)*r2(i);%第二站誤差半徑?
???
????if?R1(i)>R2(i)
???????Re(i)=R2(i);
????else
???????Re(i)=R1(i);
- 上一篇:基于區域生長法的圖像分割matlab程序
- 下一篇:自適應matlab程序
評論
共有 條評論