blob: 0878a9be7d6e9cd2084e470bfbd6d883464b0312 (
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
27
28
|
function [v] = get_approx_v(cur_seg, car)
%GET_APROX_V Retunerar medelhastiheten för nuvarande segment från tidigare
%varv
%{
In:
cur_seg: Nuvarande segment
car: en struct - se do_car.m
Ut:
v: Uppskattning av nuvarande hastiheten [m/s]
%}
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
|
