Commit a0688535 authored by Fredrik Bagge Carlson's avatar Fredrik Bagge Carlson
Browse files

update state_machine

parent 66d649c6
......@@ -2,7 +2,7 @@ d2r = 180/pi;
th_az = 5; % Degrees
step_distance = 0.1; % meters
% sendPosition.moveRelativePosition('map', moveFront, moveLeft, rotateClockwise);
th_dist = 0.78;
while(true)
......@@ -18,8 +18,9 @@ while(true)
end
% The angle to the source is small enough, take a step forward
[there, ic] = get_distance(audio, th_dist);
if ~there()
if ~there
sendPosition.moveRelativePosition('map', step_distance, 0, 0);
continue
end
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment