PX4 Firmware
PX4 Autopilot Software http://px4.io
Tbn_312.c
Go to the documentation of this file.
1 t2 = sin(yaw);
2 t3 = cos(yaw);
3 t4 = sin(pitch);
4 t5 = cos(pitch);
5 t6 = sin(roll);
6 t7 = cos(roll);
7 A0[0][0] = t3*t5-t2*t4*t6;
8 A0[0][1] = -t2*t7;
9 A0[0][2] = t3*t4+t2*t5*t6;
10 A0[1][0] = t2*t5+t3*t4*t6;
11 A0[1][1] = t3*t7;
12 A0[1][2] = t2*t4-t3*t5*t6;
13 A0[2][0] = -t4*t7;
14 A0[2][1] = t6;
15 A0[2][2] = t5*t7;
A0[0][0]
Definition: Tbn_312.c:7
t4
Definition: Tbn_312.c:3
Dual< Scalar, N > cos(const Dual< Scalar, N > &a)
Definition: Dual.hpp:286
t3
Definition: Tbn_312.c:2
t2
Definition: Tbn_312.c:1
t5
Definition: Tbn_312.c:4
t6
Definition: Tbn_312.c:5
t7
Definition: Tbn_312.c:6
Dual< Scalar, N > sin(const Dual< Scalar, N > &a)
Definition: Dual.hpp:279