asym.m

姿态定位完整的matlab算法

function m = Asym(v) 
%求反对称阵
    m = [ 0,      -v(3),  v(2); 
          v(3),   0,      -v(1); 
          -v(2),  v(1),   0     ];