%Establish Mass Matrix
mass = 90;  %kg
zg = 0.9656;

M = zeros(6,6);
M(1,1) = mass;
M(2,2) = mass;
M(3,3) = mass;
M(5,1) = -mass*zg;
M(1,5) = -mass*zg;
M(4,2) = mass*zg;
M(2,4) = mass*zg;

m = mass;
A = 1;
d = .320;  %Water plane diameter (m)
Awp = pi*d^2/4;
g = 9.8;  %m/s^2
rho = 1025;  %kg/m^3

xi3 = (A*F{7,3}./(4))./(-w.^2.*(m-real(F{3,3}))+imag(F{3,3})+rho*g*Awp);





