fourplus.m

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

function g =fourplus(p,q)
% circle yie
g=[p(1)-q(1);p(2)-q(2); p(3)-q(3);p(4)-q(4)];
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%5.