www.pudn.com > hmodeinitial.rar > hmodeinitial.m
function [o,g,h,q,perr,xk]=hmodeinitial(T,r,e,zx,zy,xk1s,yk1s,vxks,vyks,perr11,perr12,perr22) o=[1,T,0,0,0.5*T^2,0;0,1,0,0,T,0;0,0,1,T,0,0.5*T^2;0,0,0,1,0,T;0,0,0,0,1,0;0,0,0,0,0,T]; h=[1,0,0,0,0,0;0,0,1,0,0,0]; g=[T^2/4,0;T/2,0;0,T^2/4;0,T/2;1,0;0,1]; q=[10000,0;0,10000]; jsx=0.5*(zx(r-1/(1-e))-xk1s(r-1/(1-e))); jsy=0.5*(zy(r-1/(1-e))-yk1s(r-1/(1-e))); vx=vxks(r-1/(1-e)-1)+2*jsx; vy=vyks(r-1/(1-e)-1)+2*jsy; xk=[zx(r-5);vx;zy(r-5);vy;jsx;jsy]; p111=10000;p112=10000;p115=5000; p155=0.25*(10000+perr11(r-6)+4*perr12(r-6)+perr22(r-6)); p122=10000+perr11(r-6)+4*perr12(r-6)+2*perr12(r-6); p125=5000+0.5*perr11(r-6)+perr22(r-6)+1.5*perr12(r-6); perr=[p111,p112,0,0,p115,0;0,p122,0,0,p125,0;0,0,100,0,0,0;0,0,0,100,0,0;0,0,0,0,p155,0;0,0,0,0,0,100]