19 lines
394 B
Matlab
19 lines
394 B
Matlab
%*** CHAPTER 3: RIGID-BODY MOTIONS ***
|
|
|
|
function omg = so3ToVec(so3mat)
|
|
% Takes a 3x3 skew-symmetric matrix (an element of so(3)).
|
|
% Returns the corresponding 3-vector (angular velocity).
|
|
% Example Input:
|
|
%{
|
|
clear;clc;
|
|
so3mat = [[0, -3, 2]; [3, 0, -1]; [-2, 1, 0]];
|
|
omg = so3ToVec(so3mat)
|
|
%}
|
|
% Output:
|
|
% omg =
|
|
% 1
|
|
% 2
|
|
% 3
|
|
|
|
omg = [so3mat(3,2); so3mat(1,3); so3mat(2,1)];
|
|
end |