fouryie.m

基于四元数的机构综合建立模型的MATLAB程序

function g =fouryie(p)
% circle times
g=[p(1);-p(2);- p(3);-p(4)];
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%5.