%*** 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