資源簡介
用matlab實現(xiàn)導(dǎo)航系統(tǒng)中計算多普勒頻移,輸入接收機(jī)所在處的經(jīng)緯高,(f0,d0,h0)以及間隔時間(t0),和信號對應(yīng)波長頻率(f),k為分析的毫秒數(shù)(此處設(shè)為1即可),利用拉格朗日差值和單位觀測向量的計算實現(xiàn)對多普勒頻移的求解。
代碼片段和文件信息
function?fd?=?exchange(f0d0h0t0fk)
%輸入接收機(jī)所在處的緯、徑、高(f0d0h0)以及間隔時間(t0),和信號對應(yīng)波長頻率(f)k為分析的毫秒數(shù)(此處設(shè)為1即可)
%坐標(biāo)轉(zhuǎn)換,打開存放坐標(biāo)的文件,再將之從‘大地坐標(biāo)系’轉(zhuǎn)換成‘地心地固坐標(biāo)系’。B是地心地固坐標(biāo)系。
%注意:此程序每次只能在兩個相鄰的數(shù)據(jù)點中間插入所需量的數(shù)據(jù)
%t0=?0.001;%s
%f0?=?114.3316;
%d0?=?30.5772;
%h0?=?3963;?%mile???地球橢球體長半徑(赤道半徑)?????1mile=1.609km
%f?=?1023000;
?%???format?long?g;
????A?=?xlsread(‘MDatas_lla.xlsx‘);
??%k是分析的毫秒數(shù)
??%??k?=?1;
%===========================坐標(biāo)轉(zhuǎn)換開始====================================
????M?=?size(A1);
????X?=?zeros(1M);
????Y?=?zeros(1M);
????Z?=?zeros(1M);
????a?=?3963;???%?長半徑(赤道半徑)???6378.2km
????b?=?3950;???%?短半徑(極軸半徑)???6356.8km
????e2?=?(a^2?-?b^2)/a^2;
????B?=?zeros(M3);
????for?numb?=?1:M
????%N是卯酉圈曲率半徑
????????N?=?a/sqrt(1?-?e2*(sin(A(numb1)*pi/180))^2);
????????X(1numb)?=?(N?+?A(numb3))?*?cos(A(numb1)*pi/180)?*?cos(A(numb2)*pi/180);
????????Y(1numb)?=?(N?+?A(numb3))?*?cos(A(numb1)*pi/180)?*?sin(A(numb2)*pi/180);
????????Z(1numb)?=?(N*(1?-?e2)?+?A(numb3))?*?sin(A(numb1)*pi/180);
????????B(numb1)?=?X(1numb);
????????B(numb2)?=?Y(1numb);
????????B(numb3)?=?Z(1numb);
????end
%本地坐標(biāo)轉(zhuǎn)換成地心地固坐標(biāo),C是本地坐標(biāo)的地心地固坐標(biāo)。
%n0也是卯酉圈曲率半徑
????n0?=?a/sqrt(1?-?e2*(sin((f0)*pi/180))^2);
????x0?=?(n0?+?h0)*cos(f0*pi/180)*cos(d0*pi/180);
????y0?=?(n0?+?h0)*cos(f0*pi/180)*sin(d0*pi/180);
????z0?=?(n0*(1-e2)?+?h0)*sin(f0*pi/180);
????C?=?
- 上一篇:小波分析matlab程序
- 下一篇:Matlab實現(xiàn)音頻降噪
評論
共有 條評論