FEM-Course-Matlab/12+13框架结构动力分析（模态分析+时程分析）/main_frame.m

clc,clear,close all
tic
nodeCoord=[0 0;0 3;0 6 ;0 9; 5 0;5 3;5 6;5 9];
x=nodeCoord(:,1)'; % <EFBFBD>ڵ<EFBFBD>x<EFBFBD>᷽<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
y=nodeCoord(:,2)'; % <EFBFBD>ڵ<EFBFBD>y<EFBFBD>᷽<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
A=0.08;E=3e10;I=0.0128/12; % <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>͵<EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
rho=3000;
%<EFBFBD><EFBFBD>Ԫ<EFBFBD><EFBFBD>Ϣ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ţ<EFBFBD><EFBFBD>ڵ<EFBFBD>1<EFBFBD><EFBFBD><EFBFBD>ţ<EFBFBD><EFBFBD>ڵ<EFBFBD>2<EFBFBD><EFBFBD><EFBFBD>ţ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ<EFBFBD><EFBFBD>
ele=[1 1 2 A E I;2 2 3 A E I; 3 3 4  A E I;4 5 6 A E I; 5 6  7 A E I;6 7 8  A E I;7 2 6  A E I;8 3 7 A E I;9 4 8 A E I];;
%<EFBFBD>غ<EFBFBD><EFBFBD><EFBFBD>Ϣ<EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ţ<EFBFBD>x<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>y<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>z<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
Load=[4 2e5 0 0];
%Լ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ţ<EFBFBD>x<EFBFBD><EFBFBD><EFBFBD><EFBFBD>Լ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>y<EFBFBD><EFBFBD><EFBFBD><EFBFBD>Լ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>z<EFBFBD><EFBFBD><EFBFBD><EFBFBD>Լ<EFBFBD><EFBFBD>
Constr=[1 0 0 0;5 0 0 0];
Dofs=3*size(x,2); %<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɶ<EFBFBD><EFBFBD><EFBFBD>
EleCount=size(ele,1); %<EFBFBD><EFBFBD>Ԫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
K=zeros(Dofs,Dofs); %<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>նȾ<EFBFBD><EFBFBD><EFBFBD>
M=zeros(Dofs,Dofs); %<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
F=zeros(Dofs,1); %<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>غ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
U=zeros(Dofs,1); %<EFBFBD><EFBFBD><EFBFBD><EFBFBD>λ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
BarLength=BarsLength(x,y,ele);
figure('Name','Undeformed Truss')
RenderFrame(ele,Load,Constr,x,y,U,1,'-k',1) %<EFBFBD><EFBFBD><EFBFBD>ƿ<EFBFBD><EFBFBD><EFBFBD>

hold on
%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD>Ԫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD>ն<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ֿ<EFBFBD><EFBFBD><EFBFBD>װ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ն<EFBFBD><EFBFBD><EFBFBD>
for iEle =1:EleCount
        %<EFBFBD>õ<EFBFBD>Ԫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD><EFBFBD>ı<EFBFBD><EFBFBD><EFBFBD>
        n1=ele(iEle,2);n2=ele(iEle,3);
        %<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>任<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
        R=CoordTransform([x(n1) x(n2)],[y(n1) y(n2)],BarLength(iEle));
        %<EFBFBD><EFBFBD><EFBFBD>㵥Ԫ<EFBFBD>նȾ<EFBFBD><EFBFBD><EFBFBD> Ke=R'*ke*R;<EFBFBD>ֲ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ϵ<EFBFBD>µĵ<EFBFBD>Ԫ<EFBFBD>ն<EFBFBD><EFBFBD><EFBFBD>ת<EFBFBD><EFBFBD>Ϊȫ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>µĵ<EFBFBD>Ԫ<EFBFBD>ն<EFBFBD><EFBFBD><EFBFBD>
        ke= FrameElementKe(ele(iEle,4),ele(iEle,5),ele(iEle,6),R,BarLength(iEle));
        me= FrameElementMe(A,rho,R,BarLength(iEle));
        %<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ԫ<EFBFBD>նȷֿ<EFBFBD><EFBFBD><EFBFBD>װ<EFBFBD><EFBFBD><EFBFBD>ܸ<EFBFBD><EFBFBD><EFBFBD>Ӧλ<EFBFBD><EFBFBD>
        eleDof=[n1*3-2:n1*3,n2*3-2:n2*3];
        K(eleDof,eleDof)=K(eleDof,eleDof)+ke;
        M(eleDof,eleDof)=M(eleDof,eleDof)+me;
end

for i=1:length(Constr(:,1))
    restrainedDof(1+(i-1)*3:3+(i-1)*3)=(Constr(i,1)-1)*3+[1:3];
end
activeDof=setdiff([1:Dofs]',restrainedDof);

if det(M(activeDof,activeDof))>0
    A=M(activeDof,activeDof)\K(activeDof,activeDof);
    [Vo,Do]=eig(A);
    fo=diag(sqrt(Do)/(2*pi));
    Vf=sortrows([Vo',fo],size(Vo,1)+1);
    V=Vf(:,1:size(Vo,1))';%sort eignvectgors
elseif det(K(activeDof,activeDof))>0
    A=K(activeDof,activeDof)\M(activeDof,activeDof);
    [Vo,Do]=eig(A);
    fo=power(diag(sqrt(Do)),-1)/(2*pi);
    Vf=sortrows([Vo',fo],size(Vo,1)+1);
    V=Vf(:,1:size(Vo,1))';%sort eignvectgors    
end
f=sort(fo);%<EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ƶ<EFBFBD><EFBFBD>
figure
for i=1:5
    subplot(1,5,i)
    ModeNum=i;%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ̬
    U=zeros(Dofs,1);
    U(activeDof)=V(:,ModeNum)';
    RenderFrame(ele,Load,Constr,x,y,U,1,'-.b',200) %<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ģ̬<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
    axis off
end

%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ƶ<EFBFBD><EFBFBD>
w1=2*pi*f(1);
w2=2*pi*f(2);
w3=2*pi*f(3);
w4=2*pi*f(4);
w5=2*pi*f(5);
epsilon=0.05;%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
a00=(2*epsilon*w1*w3)/(w1+w3);%<EFBFBD>ٶ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ƶ<EFBFBD><EFBFBD>Ϊw1 w3
a11=(2*epsilon)/(w1+w3);
C=a00*M+a11*K;  %<EFBFBD>γ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
%<EFBFBD><EFBFBD>ȡ<EFBFBD><EFBFBD><EFBFBD>ٶ<EFBFBD>ʱ<EFBFBD><EFBFBD>
[t,acc_x]=textread('x_acceleration.txt','%f,%f,');
dt=t(2)-t(1);
n=length(t);
vel_x = zeros(length(t),1);
dis_x = zeros(length(t),1);
for i = 2:length(t)
    vel_x(i) = trapz(acc_x(1:i),t(1:i));
end

for i = 2:length(t)
    dis_x(i) = trapz(vel_x(1:i),t(1:i));
end

figure
subplot(3,1,1)
plot(t,acc_x)
subplot(3,1,2)
plot(t,vel_x)
subplot(3,1,3)
plot(t,dis_x)
title('<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>')
mm=M(activeDof,activeDof);
kk=K(activeDof,activeDof);
cc=C(activeDof,activeDof);
% plot(tt,vw);
% %%%%%%%%%%%%%%%%
beta=0.25;
gamma=0.5;
%ע<EFBFBD><EFBFBD>newmark-beta<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>󣬿<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ǻ<EFBFBD><EFBFBD>л<EFBFBD><EFBFBD>к<EFBFBD><EFBFBD>ģ<EFBFBD>Ҳ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ǽṹ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>󣬵<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ҫ<EFBFBD><EFBFBD>NewmarkBeta1<EFBFBD><EFBFBD>ʩ<EFBFBD><EFBFBD>Լ<EFBFBD><EFBFBD>
[uu,vv,aa,ttt]=NewmarkBeta1(t,dt,gamma,beta,mm,cc,kk,acc_x,Constr);%<EFBFBD><EFBFBD><EFBFBD><EFBFBD>λ<EFBFBD><EFBFBD><EFBFBD>ٶȼ<EFBFBD><EFBFBD>ٶ<EFBFBD>
uuu=zeros(size(M,1),length(t));%λ<EFBFBD><EFBFBD>
vvv=zeros(size(M,1),length(t));%λ<EFBFBD><EFBFBD>
aaa=zeros(size(M,1),length(t));%λ<EFBFBD><EFBFBD>
uuu(activeDof,:)=uu;
vvv(activeDof,:)=vv;
aaa(activeDof,:)=aa;
for i=1:size(uuu,1)
    base_disp(i,:)=dis_x;
end
% uuu_t=uuu+base_disp;

figure%<EFBFBD><EFBFBD><EFBFBD>ƶ<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڵ<EFBFBD><EFBFBD><EFBFBD>λ<EFBFBD><EFBFBD><EFBFBD>ٶȺͼ<EFBFBD><EFBFBD>ٶ<EFBFBD>
toc %disp(['<EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD><EFBFBD>: ',num2str(toc)])
subplot(3,1,1);
plot(ttt,uu(end-2,:));
subplot(3,1,2);
plot(ttt,vv(end-2,:));
subplot(3,1,3);
plot(ttt,aa(end-2,:));

figure%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD>̿<EFBFBD><EFBFBD>ܱ<EFBFBD><EFBFBD><EFBFBD>
RenderFrame(ele,Load,Constr,x,y,uuu(:,end),1,'-.b',200) %


speed=1;%<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ٶȵ<EFBFBD>
delaytime=0;
RenderFrameMotion(ele,Load,Constr,x,y,uuu,1,'-.b',delaytime,speed) %