From d3e12ebf4b8d65532718ce3092e3cf9d79172548 Mon Sep 17 00:00:00 2001 From: Albin Date: Sun, 1 Dec 2019 16:24:05 +0100 Subject: =?UTF-8?q?tog=20bort=20on=C3=B6diga=20och=20=C3=A4ndrade=20samman?= =?UTF-8?q?fattningar=20av=20funktioner=20i=20yc4=20mappen?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- Kod/bilbana/yc4/get_approx_v.m | 28 ++++++++++++++++++++++++++++ 1 file changed, 28 insertions(+) create mode 100644 Kod/bilbana/yc4/get_approx_v.m (limited to 'Kod/bilbana/yc4/get_approx_v.m') 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 -- cgit v1.2.1