Working communication from display

1 files changed, 35 insertions, 13 deletions

diff --git a/Kod/bilbana/yc4/main.m b/Kod/bilbana/yc4/main.m
index 12f9dd1..4733055 100644
--- a/Kod/bilbana/yc4/main.m
+++ b/Kod/bilbana/yc4/main.m
@@ -5,10 +5,16 @@ cd display/ClientServerApp/Release
 !startServer
 cd ../../..
 
-global display_data;
-display_data = {};
-display_data = {display_data clear_display()};
-pause(1);
+display = struct;
+display.data = [clear_display()];
+display.out = 0;
+display.shm = 0;
+display.shm_interp = struct;
+display.shm_interp.ack = 0;
+display.shm_interp.start_code = '';
+display.shm_interp.data = [];
+display.last_send = tic;
+display.last_request = tic;
 
 disp('Startar bilbanan. Avsluta med q.')
 hf=figure('position', [0 0 eps eps], 'menubar', 'none');
@@ -16,7 +22,6 @@ hf=figure('position', [0 0 eps eps], 'menubar', 'none');
 initialize_counters(1)
 initialize_counters(2)
 
-
 config_IOs
 
 load('bilbana\files\Bana1.mat')
@@ -100,21 +105,38 @@ while 1
 	[car1, car1.stop, display_data] = do_car(car1, t, display_data);
 	[car2, car2.stop, display_data] = do_car(car2, t, display_data);
 
-	if car1.stop == true
+    if car1.stop == true
 		disp('stopped by car 1');
 		break;
-	end
-	if car2.stop == true
+    end
+    if car2.stop == true
 		disp('stopped by car 2');
 		break;
-	end
-	
-    %% DISPLAY
+    end
     
     %% END OF LOOP
     while 1                     %Whileloop med paus som k�rs till pausen �verskridit 0.07 sekunder
-        pause(0.001);
+        % DISPLAY
+        display.send_delay = tic;
+        if toc(display.last_send) > display.send_interval
+            % send all queued data
+            if ~isempty(display.data)
+                [display.out] = matlabclient(1, get_smallpackage(display.data));
+                display.data = [];
+            end
+            display.last_send = tic;
+            
+            % read internal mem from last send
+            [display.out, display.shm] = matlabclient(2);
+            [display.shm_interp.ack, display.shm_interp.start_code, display.shm_interp.data] = get_response(display.shm);
+            
+            % request internal mem
+            matlabclient(1, hex2dec(['12'; '01'; '53'; '66']));
+        end
+        disp(strjoin{'display took additional ', num2str(toc(display.send_delay))});
+        % ACTUAL END OF LOOP
         t = toc(readTime);
+        
         if t > 0.07
             if t > highToc
                 highToc = t;     %Om det nya v�rdet p� pausen �r h�gre �n den tidigare h�gsta s� sparas det som den h�gsta
@@ -124,8 +146,8 @@ while 1
             end
             break;
         end
+        pause(0.001);
     end
-    send_data_to_display();
 end
  
 %% END OF PROGRAM