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