PX4 Firmware
PX4 Autopilot Software http://px4.io
|
Go to the source code of this file.
Variables | |
t9 = q0*q3 | |
t10 = q1*q2 | |
t2 = t9+t10 | |
t3 = q0*q0 | |
t4 = q1*q1 | |
t5 = q2*q2 | |
t6 = q3*q3 | |
t7 = t3+t4-t5-t6 | |
t8 = 1.0/(t7*t7) | |
t11 = t2*t2 | |
t12 = t8*t11*4.0 | |
t13 = t12+1.0 | |
t14 = 1.0/t13 | |
A0 [0][0] = t8*t14*(q3*t3-q3*t4+q3*t5+q3*t6+q0*q1*q2*2.0)*-2.0 | |
Definition at line 14 of file calcH_YAW321.c.
t10 = q1*q2 |
Definition at line 2 of file calcH_YAW321.c.
Definition at line 10 of file calcH_YAW321.c.
Definition at line 11 of file calcH_YAW321.c.
t13 = t12+1.0 |
Definition at line 12 of file calcH_YAW321.c.
t14 = 1.0/t13 |
Definition at line 13 of file calcH_YAW321.c.
Definition at line 3 of file calcH_YAW321.c.
t3 = q0*q0 |
Definition at line 4 of file calcH_YAW321.c.
t4 = q1*q1 |
Definition at line 5 of file calcH_YAW321.c.
t5 = q2*q2 |
Definition at line 6 of file calcH_YAW321.c.
t6 = q3*q3 |
Definition at line 7 of file calcH_YAW321.c.
Definition at line 9 of file calcH_YAW321.c.
t9 = q0*q3 |
Definition at line 1 of file calcH_YAW321.c.