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