add control signal log

1 files changed, 8 insertions, 0 deletions

diff --git a/Kod/bilbana/yc4/main.m b/Kod/bilbana/yc4/main.m
index d79194d..f7fc66b 100644
--- a/Kod/bilbana/yc4/main.m
+++ b/Kod/bilbana/yc4/main.m
@@ -119,6 +119,14 @@ while 1
         % DISPLAY
         display.send_delay = tic;
         if toc(display.last_send) > display.send_interval
+            % queue control signal
+            if car1.running && car1.automatic
+                display.data = [display.data, put_text(80, 16 + (16 * 1), 'L', num2str(car1.u))];
+            end
+            if car2.running && car2.automatic
+                display.data = [display.data, put_text(80, 16 + (16 * 2), 'L', num2str(car2.u))];
+            end
+            
             % send all queued data
             if ~isempty(display.data)
                 [display.out] = matlabclient(1, get_smallpackage(display.data));