mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-02 05:04:08 +08:00
5 lines
260 B
Matlab
5 lines
260 B
Matlab
function quatOut = QuatMult(quatA,quatB)
|
|
% Calculate the following quaternion product quatA * quatB using the
|
|
% standard identity
|
|
|
|
quatOut = [quatA(1)*quatB(1)-quatA(2:4)'*quatB(2:4); quatA(1)*quatB(2:4) + quatB(1)*quatA(2:4) + cross(quatA(2:4),quatB(2:4))]; |