diff options
Diffstat (limited to 'Kod/scripts/test_givare_kompenserad.m')
| -rw-r--r-- | Kod/scripts/test_givare_kompenserad.m | 79 |
1 files changed, 79 insertions, 0 deletions
diff --git a/Kod/scripts/test_givare_kompenserad.m b/Kod/scripts/test_givare_kompenserad.m new file mode 100644 index 0000000..2ac0841 --- /dev/null +++ b/Kod/scripts/test_givare_kompenserad.m @@ -0,0 +1,79 @@ +disp('Startar bilbanan. Avsluta med q.') +hf=figure('position',[0 0 eps eps],'menubar','none'); + +initialize_counters(1) +initialize_counters(2) + +start_race(1) +start_race(2) + +config_IOs + +car1 = struct; +car2 = struct; + +while 1 + %% PRE-LOOP + if strcmp(get(hf,'currentcharacter'),'q') + close(hf) + break + end + + figure(hf) + drawnow + + %% READ + [car1.new_lap, car1.new_check_point, car1.time] = get_car_position(1); + [car2.new_lap, car2.new_check_point, car2.time] = get_car_position(2); + + if car1.new_lap || car1.new_check_point == true || car2.new_lap == true || car2.new_check_point == true + disp('###') + end + + if car1.new_check_point + beep; + disp('car 1 cp') + end + if car2.new_check_point + beep; + disp('car 2 cp') + end + if car1.new_lap + beep; + disp('car 1 lap') + end + if car2.new_lap + beep; + disp('car 2 lap') + end + % KOMPENSERA FÖR TRASIG BANA + if car1.new_lap && (car2.new_check_point || car1.new_check_point) + car2.new_lap = 0; + elseif car1.new_lap + car2.new_lap = 1; + end + pause(0.1) + + if car1.new_lap || car1.new_check_point == true || car2.new_lap == true || car2.new_check_point == true + disp('---') + end + + if car1.new_lap + disp('New lap car 1') + end + if car1.new_check_point + disp('New checkpoint car 1') + end + if car2.new_lap + disp('NEW LAP CAR 2!') + end + if car2.new_check_point + disp('NEW CHECKPOINT CAR 2!') + end + + pause(0.1) +end + +%% +terminate(1) +terminate(2)
\ No newline at end of file |