rotvec.m

来自「Robotics TOOLBOX The Toolbox provides m」· M 代码 · 共 33 行

%ROTVEC Rotation about arbitrary axis
%
% 	TR = ROTVEC(V, THETA)
%
% Returns a homogeneous transformation representing a rotation of THETA 
% about the vector V.
%
% See also: ROTX, ROTY, ROTZ.

% Copyright (C) 1993-2002, by Peter I. Corke
%
% CHANGES:
% 7/01	unitize the vector
% $Log: rotvec.m,v $
% Revision 1.3  2002/04/01 11:47:16  pic
% General cleanup of code: help comments, see also, copyright, remnant dh/dyn
% references, clarification of functions.
%
% $Revision: 1.3 $

function r = rotvec(v, t)

	v = unit(v);
	ct = cos(t);
	st = sin(t);
	vt = 1-ct;
	v = v(:);
	r =    [ct		-v(3)*st	v(2)*st
		v(3)*st		ct		-v(1)*st
		-v(2)*st	v(1)*st		ct	];
		r
	r = [v*v'*vt+r zeros(3,1); 0 0 0 1];