blob: a70e18a44fb6b2ac16a268b251b9feeb7fa89889 (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
|
function [v] = get_aprox_v(cur_seg, car)
%GET_APROX_V Tillf�llig? Beh�vs f�r att testa get_position. Ger
%medelhastigheten f�r nuvarande segment p� f�rra varvet.
%{
cur_seg: Nuvarande segment
last_seg_times: 1x9 vektor med f�rra varvets segmenttider
%}
% seg_len = [];
lap = car.lap;
if cur_seg > 9
cur_seg = cur_seg - 9;
end
%% Kompensera för väldigt långsamt segment 1 första varvet
if cur_seg == 1 && lap == 2
v = car.seg_len(1)/(1.4*car.seg_times(1,9));
return
end
%% Sätt v
while lap > 0
lap = lap - 1;
if car.seg_times(lap, cur_seg) ~= 0
v = car.seg_len(cur_seg) / car.seg_times(lap, cur_seg);
return
end
end
end
|
