ppgift 2, körning med gupp Anton Hagelberg och Filip Johansson

clear all; clc; close all;
rel_tol = 1e-6;
k1 = 5300;
k2 = 163000;
Tstart = 1;
Tslut = 100;
Tspan = Tstart:Tslut;
m1 = 470;
m2 = 50;
c1 = 310;
c2 = 1200;
v_param = 65/3.6;
H_param = 0.2;
L = 1;
z = [0 0];
zprick = [0 0];

H = [0 0 1 0; 0 0 0 1; -(k1/m1), (k1/m1), (-c1/m1), (c1/m1); k1/m2, -((k1+k2/m2)), c1/m2, -((c1+c2)/m2)];




    v = [z(1), z(2), zprick(1), zprick(2)];
    g = [0 0 0 (k2*h_func(H_param, v_param, t, L)/m2)+((c2*h_prickfunc(H_param, v_param, t, L))/m2)];




function h = h_func(H_param, v_param, t, L)
    if t < L/v
        h = (H_param/2)*(1-cos((2*pi*v_param*t)/L));
    else
        h = 0;
    end

end

function h_prick = h_prickfunc(H_param, v_param, t, L)

    h_prick = (pi*H_param*v_param*sin((2*pi*v_param*t)/L))/L;

end