clc %czyszczenie ekranu
clear all %usunięcie wszystkich zmiennych z pamięci

hy = 0.05;
hz = 0.05;

Iz = 1; %hz*hy^3 / 12;
E = 1; %2.1e11; %2.1*10^11
l =  1; 

K1 = MacierzSztywnosciBelka(E, Iz, 4*l);
K2 = MacierzSztywnosciBelka(E, Iz, 2*l);

%globalna macierz sztywności

K = zeros(6,6);

K = [K1(1,1) K1(1,2) K1(1,3) K1(1,4) 0 0;
     K1(2,1) K1(2,2) K1(2,3) K1(2,4) 0 0;
     K1(3,1) K1(3,2) K1(3,3)+K2(1,1) K1(3,4)+K2(1,2) K2(1,3) K2(1,4);
     K1(4,1) K1(4,2) K1(4,3)+K2(2,1) K1(4,4)+K2(2,2) K2(2,3) K2(2,4);
           0       0 K2(3,1) K2(3,2) K2(3,4) K2(3,4);
           0       0 K2(4,1) K2(4,2) K2(4,3) K2(4,4)]
     
       
A = K;       

A(1,:) = [];
A(2,:) = [];
A(3:4,:) = [];

A(:, 1) = [];
A(:, 2) = [];
A(:, 3:4) = [];
       
q = 2000;

f = [-q*(4*l)^2/12; -q*(2*l)^2/12+q*(4*l)^2/12];

fi = A\f;
fi * 180/pi

q0 = [0; fi(1); 0; fi(2); 0; 0];

f = K*q0

R1y = f(1)+2*q*l
R2y = f(3)+2*q*l+q*l
R3y = f(5)+q*l
M3z = f(6)-q*(2*l)^2/12