Guest User

Untitled

a guest
Sep 13th, 2013
353
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.51 KB | None | 0 0
  1. % define symbolic terms
  2. x = sym('x','real');
  3. y = sym('y','real');
  4. z = sym('z','real');
  5. n1 = sym('n1','real');
  6. n2 = sym('n2','real');
  7. n3 = sym('n3','real');
  8. a = sym('a','real');
  9. b = sym('b','real');
  10. c = sym('c','real');
  11.  
  12. % assumption
  13. assume(n1^2+n2^2+n3^2==1);
  14.  
  15. % define terms
  16. sintheta=(n3)/(n1^2+n2^2+n3^2)^(0.5);
  17. costheta=(n1^2+n2^2)^(0.5)/(n1^2+n2^2+n3^2)^(0.5);
  18. u=[-n2;n1;0];
  19. uX=[0,0,n1;0,0,n2;-n1,-n2,0];
  20.  
  21. % create rotation matrix
  22. Q=costheta*eye(3)+sintheta*uX+(1-costheta)*u*u.';
  23. Q=simplify(Q)
Advertisement
Add Comment
Please, Sign In to add comment