Merge branch 'master' of gitlab.control.lth.se:letter2martin/turtlerob1

state_machine.m

+% States
+
+
+while(true)
+    audio = get_audio();
+    
+    az = get_azimuth();
+    
+    set_ref_az(-az);
+    
+    if ~abs(az) < th_az
+        continue
+    end
+    
+    % The angle to the source is small enough, take a step forward
+    
+    step_forward(distance);
+    
+    if ~there()
+        continue
+    end
+    
+    % We are there, analyze the source
+    
+    source_label = analyze_source(audio);
+    display('Source label determined')
+    disp(source_label)
+    key = input('Press any key to continue, press c to exit: ','s');
+    if key == 'c'
+        break
+    end
+    
+end
\ No newline at end of file