23 lines
454 B
Matlab
23 lines
454 B
Matlab
%*** CHAPTER 3: RIGID-BODY MOTIONS ***
|
|
|
|
function [omghat, theta] = AxisAng3(expc3)
|
|
% Takes A 3-vector of exponential coordinates for rotation.
|
|
% Returns the unit rotation axis omghat and the corresponding rotation
|
|
% angle theta.
|
|
% Example Input:
|
|
%{
|
|
clear; clc;
|
|
expc3 = [1; 2; 3];
|
|
[omghat, theta] = AxisAng3(expc3)
|
|
%}
|
|
% Output:
|
|
% omghat =
|
|
% 0.2673
|
|
% 0.5345
|
|
% 0.8018
|
|
% theta =
|
|
% 3.7417
|
|
|
|
theta = norm(expc3);
|
|
omghat = expc3 / theta;
|
|
end |