summaryrefslogtreecommitdiffstats
path: root/Kod/bilbana/yc4
diff options
context:
space:
mode:
authorAlbin <albwa833@student.liu.se>2019-11-06 17:39:00 +0100
committerAlbin <albwa833@student.liu.se>2019-11-06 17:39:00 +0100
commit8f8c2e89d8f2373eeca8f39c80b6001cae383ffa (patch)
treeee787fe59861951aeb06e3dad22814eab495bc0b /Kod/bilbana/yc4
parent06991623c226f3014ef51bb75bcbcbec6278ab00 (diff)
downloadtfyy51-8f8c2e89d8f2373eeca8f39c80b6001cae383ffa.tar.gz
Började skriva på missade givare
Diffstat (limited to 'Kod/bilbana/yc4')
-rw-r--r--Kod/bilbana/yc4/choose_position.m9
-rw-r--r--Kod/bilbana/yc4/detect_missed.m9
2 files changed, 18 insertions, 0 deletions
diff --git a/Kod/bilbana/yc4/choose_position.m b/Kod/bilbana/yc4/choose_position.m
new file mode 100644
index 0000000..36e4657
--- /dev/null
+++ b/Kod/bilbana/yc4/choose_position.m
@@ -0,0 +1,9 @@
+function [outputArg1,outputArg2] = choose_position(position,segment,t_missed)
+%CHOOSE_POSITION Välj vad position ska vara
+% Väljer position om ingen indata. Om indata kollar den om indatan är
+% rimlig eller om någon givare missats. Sedan väljs position efter vilken
+% givare det var som passerades.
+outputArg1 = inputArg1;
+outputArg2 = inputArg2;
+end
+
diff --git a/Kod/bilbana/yc4/detect_missed.m b/Kod/bilbana/yc4/detect_missed.m
new file mode 100644
index 0000000..caad2ac
--- /dev/null
+++ b/Kod/bilbana/yc4/detect_missed.m
@@ -0,0 +1,9 @@
+function [out] = detect_missed( position, segment, track)
+%DETECT_MISSED Retunerar true om position ligger utanför nuvarande segment
+%
+track_len = [2.53 3.05 4.73 7.68 8.98 10.93 14.96 17.57 19.60;
+ 0 0 0 0 0 0 0 0 0 ]; % TODO bana 2
+a = track_len(track, segment);
+out = a <= position;
+end
+