diff options
| author | Albin <albwa833@student.liu.se> | 2019-12-01 16:24:05 +0100 |
|---|---|---|
| committer | Albin <albwa833@student.liu.se> | 2019-12-01 16:24:05 +0100 |
| commit | d3e12ebf4b8d65532718ce3092e3cf9d79172548 (patch) | |
| tree | c146909d431f5a471ea34c7dfb32d4cd5a7b9c32 /Kod/bilbana/yc4/get_approx_v.m | |
| parent | cada9bb54253233f13a7c6124d2a28a6121172b5 (diff) | |
| download | tfyy51-d3e12ebf4b8d65532718ce3092e3cf9d79172548.tar.gz | |
tog bort onödiga och ändrade sammanfattningar av funktioner i yc4 mappen
Diffstat (limited to 'Kod/bilbana/yc4/get_approx_v.m')
| -rw-r--r-- | Kod/bilbana/yc4/get_approx_v.m | 28 |
1 files changed, 28 insertions, 0 deletions
diff --git a/Kod/bilbana/yc4/get_approx_v.m b/Kod/bilbana/yc4/get_approx_v.m new file mode 100644 index 0000000..0878a9b --- /dev/null +++ b/Kod/bilbana/yc4/get_approx_v.m @@ -0,0 +1,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 |
