人椅系统离机过程六自由度计算.doc

《飞行器救生及生命保障技术》 人椅系统离机过程六自由度计算 一、已知参数，计算结束状态 人-椅系统质量 :m=210kg; 222 人-椅系统气动力系数：Cx2=0.52915; Cy2=-1.05665; Cz2=0.00091; 人-椅系统气动力矩系数：mx2=0.01246; my2=0.09410; mz2=0.94347; 人-椅系统转动惯量:Jx2=34.4 kg·㎡; Jy2=44.5 kg·㎡; Jz2=21.1 kg·㎡; 人-椅系统转动惯量积: Jx2y2=0 kg·㎡; 人-椅系统正面投影面积: A=0.58 ㎡; 大气密度: ρ=1.225kg/m3; 稳定伞阻力特：（CA）ws=0.07 ㎡ ;0.065 火箭推力：F=20000 N; 25000 人椅系统重心位置：x=0.24 m; y=0.357 m; 人椅系统参考长度：L=1.115 m; 火箭安装偏心距：ef=-0.02 m; 0.02 火箭包安装角：βt=19.5° ; 人椅系统迎角：α=-80°; 人椅系统侧滑角：β=0°; 二、源程序 function dy=liuziyou(t,y) %人椅系统离机过程六自由度计算程序 dy=zeros(12,1); F= (0=t t=0.3455)*20000 + (t0.3455 t=2.0)*0; %F=20000; bt=19.5/180*pi; m=210.0; ef=-0.02; Aw=1.0; Cw=0.07; xs=Aw*Cw; g=9.8; G=m*g; L=1.115; Lp=0.7*L; x0=0.24; az=asin(x0/Lp); Jx2=34.4; Jy2=44.5; Jz2=21.1; Jx2y2=-8.3; A=0.58; rf=atan(-y(2)/y(1)); Cz2=5.6524*rf.^19+3.5158*rf.^18-46.6435*rf.^17-28.6264*rf.^16+152.3251*rf.^15+91.5226*rf.^14-250.0942*rf.^13-144.978*rf.^12+214.0682*rf.^11+116.0831*rf.^10-84.6499*rf.^9-39.2751*rf.^8+4.6120*rf.^7-0.6072*rf.^6+6.0017*rf.^5+2.6197*rf.^4-1.3015*rf.^3-0.2439*rf.^2+0.122*rf+0.0072; Cy2= 0.021*rf.^6 - 0.028*rf.^5 - 0.114*rf.^4 - 0.058*rf.^3 + 0.284*rf.^2 + 0.927*rf- 0.347; Cx2 = -0.011*rf.^6 + 0.054*rf.^5 + 0.071*rf.^4 - 0.078*rf.^3 - 0.559*rf.^2 - 0.271*rf. + 1.157; mz2=0.010*rf.^6 + 0.041*rf.^5 - 0.113*rf.^4 - 0.012*rf.^3 + 0.150*rf.^2 - 0.669*rf. + 0.253; mx2=15.3478*rf.^19+1.5623*rf.^18-132.1793*rf.^17-12.9746*rf.^16+460.1213*rf.^15+42.8189*rf.^14-835.8566*rf.^13-71.6826*rf.^12+853.5107*rf.^11+64.0635*rf.^10-490.6995*rf.^9-28.9383*rf.^8+149.4458*rf.^7+5.1056*rf.^6-20.2477*rf.^5+0.106*rf.^4+0.6304*rf.^3-0.0471*rf.^2-0.0016*rf-0.0056; my2=0.0044*rf.^6 - 0.0059*rf.^5 - 0.026*rf.^4 + 0.034*rf.^3 + 0.045*rf.^2 - 0.086*rf+ 0.015; vx=y(1)*cos(y(7))*cos(y(8))+y(2)*(sin(y(8))*sin(y(9))-cos(y(8))*sin(y(7))*cos(y(9)))+y(3)*(cos(y(9))*sin(y(8))+cos(y(8))*sin(y(7))*sin(y(9))); vy=y(1)*sin(y(7