root/branches/atorf/RWTHMindstormsNXT-Lejos-Combined/@NXTmotor/wait.m @ 267

function [ timedOut ] = wait( obj , timeout)
% WAIT Wait for motor to stop (busy waiting)
%   
%     WAIT(OBJ) waits for motor specified by OBJ to stop.
%     We do this by reading the motor settings from the NXT 
%     brick repeatedly until the RunState goes to 'idle'. If the motor
%     is set to run infinitely, return immediately and display a 
%     warning.
%
%     TIMEDOUT = WAIT(OBJ, TIMEOUT) does the same as described 
%     above but has an additional timeout TIMEOUT (given in 
%     seconds). After this time the function stops waiting and
%     returns
%
%     Example:
%         % Instantiate Motor and run it
%         m = NXTmotor('A', 'Power', 50, 'MotorOn', 1, ...
%                      'RunState', 'running', 'TachoLimit', 1000);
%         send(m);
%         % Wait for the motor
%         t = wait(m, 0.5);
%         if t ~= 0
%             disp('Timed out');
%         end
%
%     See also NXTmotor/set, NXTmotor/get.
%

% Author: Aulis Telle, IND, RWTH Aachen

if nargout > 0
    timedOut = 0;
end

if ~exist('timeout','var')
    timeout = 0;
end

starttime = now;
endtime = starttime + datenum(0,0,0,0,0,timeout);

data = read(obj);
if data.TachoLimit == 0 && ~ strcmp(data.RunState,'idle')
    warning('RWTHMINDSTORMS:MotorWait',...
        'Motor running infinitely. Not waiting for this motor!');
    return;
end

while ~ strcmp(data.RunState,'idle')
    if exist('timedOut', 'var') && timeout > 0 && now >= endtime
        timedOut = 1;
        break;
    end
    pause(0.002);
    data = read(obj);
end