root/branches/atorf/RWTHMindstormsNXT/GetUltrasonic.m @ 296

function [DistanceCM] = GetUltrasonic(port)
% Reads the current value of the NXT ultrasonic sensor
%
% Syntax
%   |distance = GetUltrasonic(port)|
%
% Description
%   |distance = GetUltraSonic(port)| returns the current measurement value |distance| of the NXT
%   ultrasonic sensor. |distance| represents the measured distance in cm.
%   The given |port| number specifies the connection port. The value |port| can be
%   addressed by the symbolic constants |SENSOR_1| , |SENSOR_2|, |SENSOR_3| and |SENSOR_4| analog to
%   the labeling on the NXT Brick.
%
%   For more complex settings the functions |NXT_LSRead| and |NXT_LSWrite| can be used.
%
% Example
%+   OpenUltrasonic(SENSOR_4);
%+   distance = GetUltrasonic(SENSOR_4);
%+   CloseSensor(SENSOR_4);
%
% See also: OpenUltrasonic, USMakeSnapshot, USGetSnapshotResults, CloseSensor, NXT_LSRead, NXT_LSWrite
%
% Signature
%   Author: Linus Atorf, Alexander Behrens (see AUTHORS)
%   Date: 2008/01/15
%   Copyright: 2007-2008, RWTH Aachen University
%
;
%
% ***********************************************************************************************
% *  This file is part of the RWTH - Mindstorms NXT Toolbox.                                    *
% *                                                                                             *
% *  The RWTH - Mindstorms NXT Toolbox is free software: you can redistribute it and/or modify  *
% *  it under the terms of the GNU General Public License as published by the Free Software     *
% *  Foundation, either version 3 of the License, or (at your option) any later version.        *
% *                                                                                             *
% *  The RWTH - Mindstorms NXT Toolbox is distributed in the hope that it will be useful,       *
% *  but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS  *
% *  FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details.             *
% *                                                                                             *
% *  You should have received a copy of the GNU General Public License along with the           *
% *  RWTH - Mindstorms NXT Toolbox. If not, see <http://www.gnu.org/licenses/>.                 *
% ***********************************************************************************************


    % also accept strings as input
    if ischar(port)
        port = str2double(port);
    end%if


    % The old version looked like this:
    %RequestLen = 1;
    %I2Cdata = hex2dec(['02'; '42']); % Read Measurement Byte 0 (see LEGO Mindstorms NXT 
    %                                 % Ultrasonic Sensor - I2C Communication Protocol)

    % retrieve 1 byte from device 0x02, register 0x42
    data = COM_ReadI2C(port, 1, uint8(2), uint8(66));
    
    if isempty(data)
        DistanceCM = -1;
    else
        % this double() is so important!!!
        DistanceCM = double(data(1));
    end%if


    
end%function