circle_lgkt1.m

惯性导航精解算程序

function circle_lgkt1()
dT = .1;
totaltime = 3600;

fai0 =0;
Rad = 10^4;%标称轨迹 匀速圆周运动，半径Rad,转速Ww
Ww = 2*pi/(0.5*3600);%半小时一圈
Vv= Rad*Ww;
tt = [0:dT:totaltime]';
true_step = size(tt,1);
LL0 = [0 Rad];
Vv0 = [Vv*cos(fai0) -Vv*sin(fai0)];
aL0 = [-Ww^2*Rad*sin(fai0) -Ww^2*Rad*cos(fai0)];
hWaitBar = waitbar(0,'Please wait...');
for i=1:true_step  
    LL(i,:) = LL0+Vv0*dT;
    VL(i,:) = Vv0+aL0*dT; 
    fai0 = fai0+Ww*dT;
    if fai0>2*pi
        fai0 = fai0-2*pi;
    end
    aL(i,:) = [-Ww^2*Rad*sin(fai0) -Ww^2*Rad*cos(fai0)];
    LL0 = LL(i,:);
    Vv0 = VL(i,:);
    aL0 = aL(i,:);
waitbar(i/true_step,hWaitBar,[num2str( fix(i/true_step*100) ),'%'])%
end
close(hWaitBar);
load Storecircle_true;
Storecircle_true;