From a61f7c5dc990559dff7fd30055f9128ec16a5830 Mon Sep 17 00:00:00 2001
From: Fredrik Bagge Carlson <fredrikb@control.lth.se>
Date: Fri, 25 Sep 2015 15:20:12 +0200
Subject: [PATCH] iii
---
state_machine.m | 6 +++++-
1 file changed, 5 insertions(+), 1 deletion(-)
diff --git a/state_machine.m b/state_machine.m
index 48bdd0c..7babafc 100644
--- a/state_machine.m
+++ b/state_machine.m
@@ -1,11 +1,13 @@
d2r = 180/pi;
+fs = 24414;
th_az = 5; % Degrees
step_distance = 0.1; % meters
th_dist = 0.78;
+icvec = zeros(100,1);
% sendPosition.moveRelativePosition('map', moveFront, moveLeft, rotateClockwise);
-
+it = 1;
while(true)
pause(0.01)
@@ -21,6 +23,8 @@ while(true)
% The angle to the source is small enough, take a step forward
[there, ic] = get_distance(audio, th_dist, 0);
+ icvec(it) = ic;
+ it = it + 1;
if ~there
sendPosition.moveRelativePosition('map', step_distance, 0, 0);
--
GitLab