clear;

clc;
Ma=[22 5.5 5.5 5.5;5.5 5.5 0 0;5.5 0 5.5 0;5.5 0 0 5.5]
Ka=[139.1 0 0 0;0 40994.5 -20497.2 0;0 -20497.2 40994.5 -20497.2;0 0
-20497.2 20497.2]
[modos lambda]=eig(Ka,Ma)
modo1=[modos(1,1);modos(2,1);modos(3,1);modos(4,1)]
modo2=[modos(1,2);modos(2,2);modos(3,2);modos(4,2)]
modo3=[modos(1,3);modos(2,3);modos(3,3);modos(4,3)]
modo4=[modos(1,4);modos(2,4);modos(3,4);modos(4,4)]
frec=sqrt(diag(lambda))
T=[2*3.1416/frec(1,1);2*3.1416/frec(2,1);2*3.1416/frec(3,1);2*3.1416/frec
(4,1)]

J=[1;1;1;1]
FP1=modo1*Ma*J/(modo1*Ma*modo1)
FP2=modo2'*Ma*J/(modo2'*Ma*modo2)
FP3=modo3'*Ma*J/(modo3'*Ma*modo3)
FP4=modo4'*Ma*J/(modo4'*Ma*modo4)
Ad1=0.53;
Ad2=4.41;
Ad3=4.41;
Ad4=4.41;
U1=FP1*modo1*Ad1/(frec(1,1))^2
U2=FP2*modo2*Ad2/(frec(2,1))^2
U3=FP3*modo3*Ad3/(frec(3,1))^2
U4=FP4*modo4*Ad4/(frec(4,1))^2
r1=0.25*(U1(1,1)-U2(1,1)-U3(1,1)-U4(1,1))+0.75*((U1(1,1))^2+(U2(1,1))^2+
(U3(1,1))^2+(U4(1,1))^2)^0.5
r2=0.25*(U1(2,1)+U2(2,1)+U3(2,1)+U4(2,1))+0.75*((U1(2,1))^2+(U2(2,1))^2+
(U3(2,1))^2+(U4(2,1))^2)^0.5
r3=0.25*(U1(3,1)+U2(3,1)+U3(3,1)-U4(3,1))+0.75*((U1(3,1))^2+(U2(3,1))^2+
(U3(3,1))^2+(U4(3,1))^2)^0.5
r4=0.25*(U1(4,1)+U2(4,1)+U3(4,1)+U4(4,1))+0.75*((U1(4,1))^2+(U2(4,1))^2+
(U3(4,1))^2+(U4(4,1))^2)^0.5