6 lines
140 B
Mathematica
6 lines
140 B
Mathematica
|
function y = rodrig_formula(w_hat,theta)
|
||
|
|
%RODRI computes exo(w_hat*theta)
|
||
|
|
y = eye(3) + w_hat*sin(theta) + w_hat^2*(1-cos(theta));
|
||
|
|
end
|
||
|
|
|