%算例
%*************************************************************
%状态空间模态叠加法
%=============================================================
clc
clear
clear global
freedom=9;%自由度数
m=1;
k=400000;
c=25;
miu=400; %松弛因子
I=eye(freedom);
zero=zeros(freedom);
M=m*I;
K=k*(diag(repmat([2], 1, 9))+diag(repmat([-1], 1, 8), 1)+diag(repmat([-1], 1, 8), -1));
C=c*I;
% ======写为状态空间形式=====
P=[C M -C/miu;M zero zero;-C/miu zero C/miu^2];
Q=-[-K zero