chacheng.m

组合导航的程序

function y = chacheng(p,q)
y(1)=p(2)*q(3)-p(3)*q(2);
y(2)=p(3)*q(1)-p(1)*q(3);
y(3)=p(1)*q(2)-p(2)*q(1);