bm2xyze.m

一个研究声多普勒计程仪很好的工具箱

function theResult = bm2xyze(theElevations, theAzimuths, ...
								theHeading, thePitch, theRoll, ...
								theOrientation)
% bm2xyze -- ADCP beam to X-Y-Z-E transformation.
%  bm2xyze(theElevations, theAzimuths) returns the transformation
%   matrix that converts beam data (4 columns) to X-Y-Z-E data by
%   pre-multiplication, using RDI conventions for ADCP measurements.
%   The beam-directions point away from the transponders, whereas
%   positive velocities point toward them.  The error-vector
%   coefficients are scaled to be approximately 0.5.  All angles
%   in degrees.
%  bm2xyze(theElevations, theAzimuths, theHeading, thePitch, theRoll,
%   'theOrientation') uses the additional orientation information as
%   well.  All angles in degrees.  TheOrientation is {'down' | 'up'}.
%  bm2xyze (no arguments) demonstrates itself by returning the
%   transformation for the conventional arrangement of beams
%   pointed downwards 20 degrees from vertical, at azimuths
%   of [270 90 0 180], other angles = 0.
 
% Copyright (C) 1997 Dr. Charles R. Denham, ZYDECO.
%  All Rights Reserved.
%   Disclosure without explicit written consent from the
%    copyright owner does not constitute publication.
 
% Version of 12-May-1998 14:47:33.

% Reference: ADCP Coordinate Transformation: Formulas and
%  Calculations (technical manual, 26 pages), RD Insruments,
%  1997.

if nargin < 1
	help(mfilename)
	theElevations = [-70 -70 -70 -70]
	theAzimuths = [270 90 0 180]
	theHeading = 0
	thePitch = 0
	theRoll = 0
	theOrientation = 'down'
	theTransformation = bm2xyze(theElevations, theAzimuths, ...
							theHeading, thePitch, theRoll, ...
							theOrientation);
	if nargout > 0
		theResult = theTransformation;
	else
		theTransformation
	end
	return
end

% Default arguments.

if nargin < 2, theAzimuths = [270 90 0 180]; end
if nargin < 3, theHeading = 0; end
if nargin < 4, thePitch = 0; end
if nargin < 5, theRoll = 0; end
if nargin < 6, theOrientation = 0; end

% One elevation value given.

for i = length(theElevations)+1:4
	theElevations(i) = theElevations(i-1);
end

% From X-Y-Z to beam directions.

theBeamDirections = ...
		bm2dir(theElevations, theAzimuths, ...
				theHeading, thePitch, theRoll, ...
				theOrientation);

% From beam directions to X-Y-Z coordinates.
%  See reference page 10.

theInverse = theBeamDirections \ eye(4, 4);

% Error-vector.  See reference page 10.

theErrorVector = [theInverse(:, 1:3) \ theInverse(:, 4); -1];
theErrorVector = theErrorVector / norm(theErrorVector);

% Append.

theTransformation = [theInverse; theErrorVector.'];

% Result for outward beam-directions, with positive
%  velocities directed inwards.

result = -theTransformation;

% Output.

if nargout > 0
	theResult = result;
else
	disp(result)
end