PX4 Firmware
PX4 Autopilot Software http://px4.io
rotVarVec.c File Reference

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
 

Variable Documentation

◆ A0

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.

◆ t10

t10 = t7+t9

Definition at line 9 of file rotVarVec.c.

◆ t11

t11 = 1.0/sqrt(t4)

Definition at line 10 of file rotVarVec.c.

◆ t12

t12 = q2*t6*2.0

Definition at line 11 of file rotVarVec.c.

◆ t13

t13 = q0*q2*t3*t8*2.0

Definition at line 12 of file rotVarVec.c.

◆ t14

t14 = t12+t13

Definition at line 13 of file rotVarVec.c.

◆ t15

t15 = q3*t6*2.0

Definition at line 14 of file rotVarVec.c.

◆ t16

t16 = q0*q3*t3*t8*2.0

Definition at line 15 of file rotVarVec.c.

◆ t17

t17 = t15+t16

Definition at line 16 of file rotVarVec.c.

◆ t2

t2 = q0*q0

Definition at line 1 of file rotVarVec.c.

◆ t3

t3 = acos(q0)

Definition at line 2 of file rotVarVec.c.

◆ t4

t4 = -t2+1.0

Definition at line 3 of file rotVarVec.c.

◆ t5

t5 = t2-1.0

Definition at line 4 of file rotVarVec.c.

◆ t6

t6 = 1.0/t5

Definition at line 5 of file rotVarVec.c.

◆ t7

t7 = q1*t6*2.0

Definition at line 6 of file rotVarVec.c.

◆ t8

t8 = 1.0/pow(t4,3.0/2.0)

Definition at line 7 of file rotVarVec.c.

◆ t9

t9 = q0*q1*t3*t8*2.0

Definition at line 8 of file rotVarVec.c.