PX4 Firmware
PX4 Autopilot Software http://px4.io
Tbn_quat.c
Go to the documentation of this file.
1 float t2 = q1*q2*2.0;
2 float t3 = q0*q0;
3 float t4 = q1*q1;
4 float t5 = q2*q2;
5 float t6 = q3*q3;
6 float t7 = q0*q2*2.0;
7 float t8 = q1*q3*2.0;
8 float t9 = q2*q3*2.0;
9 A0[0][0] = t3+t4-t5-t6;
10 A0[0][1] = t2-q0*q3*2.0;
11 A0[0][2] = t7+t8;
12 A0[1][0] = t2+q0*q3*2.0;
13 A0[1][1] = t3-t4+t5-t6;
14 A0[1][2] = t9-q0*q1*2.0;
15 A0[2][0] = -t7+t8;
16 A0[2][1] = t9+q0*q1*2.0;
17 A0[2][2] = t3-t4-t5+t6;
t9
float t9
Definition: Tbn_quat.c:8
A0
A0[0][0]
Definition: Tbn_quat.c:9
t6
float t6
Definition: Tbn_quat.c:5
t5
float t5
Definition: Tbn_quat.c:4
t4
float t4
Definition: Tbn_quat.c:3
t7
float t7
Definition: Tbn_quat.c:6
t2
float t2
Definition: Tbn_quat.c:1
t8
float t8
Definition: Tbn_quat.c:7
t3
float t3
Definition: Tbn_quat.c:2