飞行器六自由度建模 线性化 matlab程序

飞行器六自由度建模，以及飞行器配平，线性化的matlab程序 matlab例程 运行正确 可供参考

clc
clear

E=2e5;
v=0.3;  %材料属性
%%定义各个矩阵
f=zeros（2112）;  %框架节点整合成二维矩阵
p=zeros（21102）;  %框架节点
ell=zeros（212）;  %椭圆节点
dot=zeros（2012）;  %整合后整体节点坐标
units=zeros（3443）;  %各单元节点编号
length=zeros（34433）; %单元的a，b，c
A=zeros（3441）;  %各单元的面积
krs=zeros（22）;
k_units=zeros（34466）;  %单元刚度矩阵
k_whole=zeros（402402）; %总体刚度矩阵

k=0;
%%%%%%%%%%%%中间内容已经正确，不需大修改！！！%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
%%求解框架点
for i=1:1:21
  for j=1:1:10
    if i<=11
        if i==1
           p（1j1）=0;
           p（1j2）=0.5*j;
        else
          p（ij1）=（i-1）*0.5/5*（j*0.5）;
         p（ij2）=j*0.5;
        end 
    else
        if i==21
            p（21j1）=0.5*j;
            p（21j2）=0;
        else
            p（ij1）=0.5*j;
            p（ij2）=（21-i）*0.5/5*0.5*j;
        end
    end
  end
end

%%框架矩阵整合
for i=1:1:21
    for j=1:1:10
        f（（i-1）*10+j+11）=p（ij1）;
        f（（i-1）*10+j+12）=p（ij2）;
    end
end
f（11）=0;
f（12）=0;

%% 椭圆点求解
for i=1:1:11
    ell（i+11）=10000000000000000./（44444444444444444444444444444445.+1000000000000000000000000000000.*i^2）^（1/2）;
    ell（i+12）=1000000000000000.0000000000000000/（44444444444444444444444444444445.+1000000000000000000000000000000.*i^2）^（1/2）*i;
end
for i=12:1:21
    ell（i1）=-10000000000000000.000000000000000/（.29600000000000000000000000000000e35-.18666666666666666666666666666667e34*i+44444444444444444444444444444445.*i^2）^（1/2）*（-21.+i）;
    ell（i2）=100000000000000000./（.29600000000000000000000000000000e35-.18666666666666666666666666666667e34*i+44444444444444444444444444444445.*i^2）^（1/2）;
end
ell（11）=1.5;
ell（12）=0;
%%整合整体点的坐标

for i=1:1:129
    d=mod（i10）;
    if d==0
        dot（i1）=ell（21-i/101）;
        dot（i2）=ell（21-i/102）;
    else
        dot（i1）=f（i+21）;
        dot（i2）=f（i+22）;
    end
end
dot（1301）=1;
dot（1302）=0.7454;
for i=131:1:194
    n=mod（i9）;
    if n==5
        dot（i1）=ell（22-（i-5）/91）;
        dot（i2）=ell（22-（i-5）/92）;
        k=k+1;
    else
        dot（i1）=f（i+k+11）;
        dot（i2）=f（i+k+12）;
    end
end
for i=195:1:201
    dot（i1）=f（i+101）;
    dot（i2）=f（i+102）;
end
% 
% ell
% f
% dot

%%计算各单元的节点号，单元共344，节点总共201
units（11）=1;
units（12）=10;
units（13）=11;
for i=1:1:8
    units（2*i1）=i;
    units（2*i2）=10+i;
    units（2*i3）=11+i;
    units（2*i+11）=11+i;
    units（2*i+12）=i+1;
    units（2*i+13）=i;
end

for j=1:1:11
    for i=10*j:1:10*j+8
        units（2*（i-j）1）=i;
        units（2*（i-j）2）=10+i;
        units（2*（i-j）3）=11+i;
        units（2*（i-j）+11）=11+i;
        units（2*（i-j）+12）=i+1;
        units（2*（i-j）+13）=i;
    end
end
units（2161）=130;
units（2162）=121;
units（2163）=120;
units（2171）=130;
units（2172）=131;
units（2173）=121;
for i=121:1:128
    units（2*i-241）=i;
    units（2*i-242）=i+10;
    units（2*i-243）=i+11;
    units（2*i-231）=i+11;
    units（2*i-232）=i+1;
    units（2*i-233）=i;
end
for i=13

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     文件          68  2011-12-15 22:31  HW4-7.m
     文件          74  2011-12-15 23:02  HW4_7.m
     文件         179  2011-12-16 09:43  HW4_71.m
     文件         437  2011-12-13 22:51  Untitled.m
     文件          96  2011-12-13 23:11  Untitled2.m
     文件        9769  2012-02-16 01:01  fem2.m
     文件        1071  2012-01-09 23:06  main.m
     文件         118  2011-12-16 09:38  myfun.m
     文件       25932  2012-01-09 22:55  step1.jpg
     文件         271  2012-01-06 14:22  step1.m
     文件       25677  2012-01-09 22:56  step2.jpg
     文件         248  2012-01-06 14:26  step2.m
     文件       68169  2012-01-09 23:03  totle.jpg
     文件         876  2012-01-09 22:52  totle.m
     文件         873  2012-01-07 17:49  zn.m
     目录           0  2013-03-28 10:37  发动机推力指数\
     文件          90  2011-12-27 22:37  发动机推力指数\theottleidle.m
     文件          81  2011-12-20 19:43  发动机推力指数\throttledelt.m
     文件          98  2011-12-27 22:38  发动机推力指数\throttlemaximum.m
     文件          93  2011-12-27 22:37  发动机推力指数\throttlemilitary.m
     目录           0  2013-03-28 10:30  标准大气模型\
     文件         247  2013-03-28 10:32  标准大气模型\ADC.m
     目录           0  2013-04-01 14:40  算气动指数alpha=1.038，beta=0\
     文件         159  2012-01-06 09:19  算气动指数alpha=1.038，beta=0\A.m
     文件         725  2012-01-06 10:14  算气动指数alpha=1.038，beta=0\Clda.m
     文件         626  2012-01-06 10:20  算气动指数alpha=1.038，beta=0\Cldr.m
     文件         161  2012-01-06 09:56  算气动指数alpha=1.038，beta=0\Clp.m
     文件         154  2012-01-06 09:59  算气动指数alpha=1.038，beta=0\Clr.m
     文件         531  2012-01-06 09:24  算气动指数alpha=1.038，beta=0\Cm.m
     文件         151  2012-01-06 09:26  算气动指数alpha=1.038，beta=0\Cmq.m
     文件         743  2012-01-06 10:21  算气动指数alpha=1.038，beta=0\Cnda.m
............此处省略13个文件信息