tests/trajectory-planner/circular-arcs/octave/estimate_depth.m


1
2
3
4
5
6
7
8
9
10
11
12

function depth = estimate_depth(a_limit,v_limit,L_min,dt)

    v_sample= L_min/(2.0*dt);
    v_max = min(v_sample,v_limit);
    v = 0;
    depth = 0;
    while v<v_max
        v = sqrt(v^2 + 2*a_limit*L_min);
        depth+=1;
    end
    
end