[y1,t1] = rk4([1+dh(1),0,0,0]', 5, dh(1));
    [y2,t2] = rk4([1+dh(2),0,0,0]', 5, dh(2));
    [minpos1,p1] = interpolation(y1,t1);
    [minpos2,p2] = interpolation(y2,t2);
    sekh = sekantmetoden(dh,minpos2(2),minpos1(2));
    dh = sekh;
    [y,t] = rk4([1+dh(end),0,0,0]', 5, dh(end));