Compute the constraint for the rotation matrix phi function diff = constraint_phi(A) Fabio Tozeto Ramos 05/10/05
0001 function [zero, diff] = constraint_phi(A) 0002 %Compute the constraint for the rotation matrix phi 0003 %function diff = constraint_phi(A) 0004 %Fabio Tozeto Ramos 05/10/05 0005 diff = A*A' - eye(3); 0006 zero =0;