qmul.m
上传用户:skyjin520
上传日期:2016-12-06
资源大小:20k
文件大小:0k
源码类别:

交通/航空行业

开发平台:

Matlab

  1. function q = qmul(q1,q2)   
  2.     q = [ q1(1) * q2(1) - q1(2) * q2(2) - q1(3) * q2(3) - q1(4) * q2(4);
  3.           q1(1) * q2(2) + q1(2) * q2(1) + q1(3) * q2(4) - q1(4) * q2(3);
  4.           q1(1) * q2(3) + q1(3) * q2(1) + q1(4) * q2(2) - q1(2) * q2(4);
  5.           q1(1) * q2(4) + q1(4) * q2(1) + q1(2) * q2(3) - q1(3) * q2(2) ];