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

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
 

Variable Documentation

◆ A0

A0[0][3] = 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

t10 = q1*q2

Definition at line 2 of file calcH_YAW321.c.

◆ t11

t11 = t2*t2

Definition at line 10 of file calcH_YAW321.c.

◆ t12

t12 = t8*t11*4.0

Definition at line 11 of file calcH_YAW321.c.

◆ t13

t13 = t12+1.0

Definition at line 12 of file calcH_YAW321.c.

◆ t14

t14 = 1.0/t13

Definition at line 13 of file calcH_YAW321.c.

◆ t2

t2 = t9+t10

Definition at line 3 of file calcH_YAW321.c.

◆ t3

t3 = q0*q0

Definition at line 4 of file calcH_YAW321.c.

◆ t4

t4 = q1*q1

Definition at line 5 of file calcH_YAW321.c.

◆ t5

t5 = q2*q2

Definition at line 6 of file calcH_YAW321.c.

◆ t6

t6 = q3*q3

Definition at line 7 of file calcH_YAW321.c.

◆ t7

t7 = t3+t4-t5-t6

Definition at line 8 of file calcH_YAW321.c.

◆ t8

t8 = 1.0/(t7*t7)

Definition at line 9 of file calcH_YAW321.c.

◆ t9

t9 = q0*q3

Definition at line 1 of file calcH_YAW321.c.