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
A0[0][0]
Definition:
Tbn_312.c:7
t4
t4
Definition:
Tbn_312.c:3
matrix::cos
Dual< Scalar, N > cos(const Dual< Scalar, N > &a)
Definition:
Dual.hpp:286
t3
t3
Definition:
Tbn_312.c:2
t2
t2
Definition:
Tbn_312.c:1
t5
t5
Definition:
Tbn_312.c:4
t6
t6
Definition:
Tbn_312.c:5
t7
t7
Definition:
Tbn_312.c:6
matrix::sin
Dual< Scalar, N > sin(const Dual< Scalar, N > &a)
Definition:
Dual.hpp:279
src
lib
ecl
EKF
matlab
scripts
Inertial Nav EKF
Tbn_312.c
Generated by
1.8.13