PX4 Firmware
PX4 Autopilot Software http://px4.io
|
Go to the source code of this file.
Variables | |
t2 = q0*q0 | |
t3 = acos(q0) | |
t4 = -t2+1.0 | |
t5 = t2-1.0 | |
t6 = 1.0/t5 | |
t7 = q1*t6*2.0 | |
t8 = 1.0/pow(t4,3.0/2.0) | |
t9 = q0*q1*t3*t8*2.0 | |
t10 = t7+t9 | |
t11 = 1.0/sqrt(t4) | |
t12 = q2*t6*2.0 | |
t13 = q0*q2*t3*t8*2.0 | |
t14 = t12+t13 | |
t15 = q3*t6*2.0 | |
t16 = q0*q3*t3*t8*2.0 | |
t17 = t15+t16 | |
A0 [0][0] = t10*(P_l_0_c_0_r_*t10+P_l_1_c_0_r_*t3*t11*2.0)+t3*t11*(P_l_0_c_1_r_*t10+P_l_1_c_1_r_*t3*t11*2.0)*2.0 | |
A0[2][0] = t10*(P_l_0_c_0_r_*t10+P_l_1_c_0_r_*t3*t11*2.0)+t3*t11*(P_l_0_c_1_r_*t10+P_l_1_c_1_r_*t3*t11*2.0)*2.0 |
Definition at line 17 of file rotVarVec.c.
Definition at line 9 of file rotVarVec.c.
t11 = 1.0/sqrt(t4) |
Definition at line 10 of file rotVarVec.c.
t12 = q2*t6*2.0 |
Definition at line 11 of file rotVarVec.c.
Definition at line 12 of file rotVarVec.c.
Definition at line 13 of file rotVarVec.c.
t15 = q3*t6*2.0 |
Definition at line 14 of file rotVarVec.c.
Definition at line 15 of file rotVarVec.c.
Definition at line 16 of file rotVarVec.c.
t2 = q0*q0 |
Definition at line 1 of file rotVarVec.c.
t3 = acos(q0) |
Definition at line 2 of file rotVarVec.c.
t4 = -t2+1.0 |
Definition at line 3 of file rotVarVec.c.
t5 = t2-1.0 |
Definition at line 4 of file rotVarVec.c.
t6 = 1.0/t5 |
Definition at line 5 of file rotVarVec.c.
t7 = q1*t6*2.0 |
Definition at line 6 of file rotVarVec.c.
t8 = 1.0/pow(t4,3.0/2.0) |
Definition at line 7 of file rotVarVec.c.
Definition at line 8 of file rotVarVec.c.