Merge branch 'stop-cars-on-keypress'

1 files changed, 16 insertions, 0 deletions

diff --git a/Kod/bilbana/yc4/do_car.m b/Kod/bilbana/yc4/do_car.m
index ce3d76c..ed8de89 100644
--- a/Kod/bilbana/yc4/do_car.m
+++ b/Kod/bilbana/yc4/do_car.m
@@ -33,6 +33,10 @@ if car.running == true
 	end
 end
 
+if car.stopped == true
+	return
+end
+
 %% READ INPUT FROM TRACK
 if car.running == true
 	if car.lap ~= 0
@@ -66,6 +70,18 @@ if car.running == true
 		end
 	end
 
+	if car.stopping == true
+		% CHECK IF CAR IS AT THE END OF TRACK
+		if car.position > (car.map(80, 1) / 100) - 0.8  % 80cm
+            disp(car.position)
+            disp((car.map(80, 1) / 100) - 300)
+			set_car_speed(car.num, 0);
+			car.stopped = true;
+			return
+		end
+	end
+			
+
 	%% CHECK POINT
 	if car.new_check_point == true
 		if car.new_lap == false % choose_position krachar vid nytt varv (seg 10)