summaryrefslogtreecommitdiffstats
path: root/Kod/bilbana/yc4/choose_position.m
diff options
context:
space:
mode:
Diffstat (limited to 'Kod/bilbana/yc4/choose_position.m')
-rw-r--r--Kod/bilbana/yc4/choose_position.m6
1 files changed, 4 insertions, 2 deletions
diff --git a/Kod/bilbana/yc4/choose_position.m b/Kod/bilbana/yc4/choose_position.m
index ae900d6..035d6e3 100644
--- a/Kod/bilbana/yc4/choose_position.m
+++ b/Kod/bilbana/yc4/choose_position.m
@@ -17,18 +17,20 @@ for i = 1:length(track_len)
if i == 1
near = [i,diff];
else
- if diff < near(i)
+ if diff < near(2)
near = [i,diff];
end
end
end
+disp(near);
%% Beräkning av passerad givare
if near(1) == segment
new_position = set_pos( track, segment);
seg_plus = 0;
+ disp('In right segment');
else
seg_plus = near(1) - segment
- new_position = set_pos( track, segment)
+ new_position = set_pos( track, segment + seg_plus)
beep
end
% TODO Bättre att utgå ifrån ingen missad givare ifall ingen annan givare