dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity
px4-firmware/EKF/matlab/scripts/Inertial Nav EKF/yaw_input_321.c

3 lines
68 B
C
Raw Blame History

A0[0][0] = q0*q3*2.0+q1*q2*2.0;
A0[1][0] = q0*q0+q1*q1-q2*q2-q3*q3;
View Git Blame Copy Permalink