Download Winter Interim

Transcript
These equations also look a little messy in the Matlab code, so here they are written out.
It can be seen from equation 9 how these equations are derived. It can now be seen why
new equations have to be written in the case that the denominator is 0. This will be done
later.
C 
Roll: φ = arctan  32 
 C33 
Pitch: θ = arcsin {− C31 }
(eq 1)
(eq 2)
C 
Yaw: ϕ = arctan  21 
 C11 
(eq 3)
It was found that the equation for ? nbb was incorrect. When relating the turn rate of the
navigation frame with respect to the earth in the navigation frame and the turn rate of the
earth with respect to the inertial frame in the navigation frame, Cn b should be used instead
of Cbn . Cbn relates the body frame to the navigation frame. Since the turn rate in the
body frame is desired, Cn b should be used.
Not much had to be done to the overall attitude computer. Deriving Cn b is done by
transposing Cbn . This was found on page 44.
Cnb = C3C 2C1
(eq 4)
Cbn = C nbT = C1T C T2 C3T
(eq 5)
 cosψ
Yaw – Rotation ? about the z axis, C1 = − sin ψ
 0
cos θ
Pitch – Rotation ? about the y axis, C2 =  0
 sin θ
sin ψ
0
0
1
(eq. 6)
0 − sin θ 
1
0 
0 cosθ 
(eq. 7)
cosψ
0
0
1

Roll – Rotation F about the x axis, C3 = 0 cos φ
0 − sin φ
cos θ cos ϕ
C =  cos θ sin ϕ
 − sin θ
n
b
− cos φ sin ϕ + sin φ sin θ cos ϕ
cos φ cos ϕ + sin φ sin θ sin ϕ
sin φ cos θ
0 
sin φ 
cos φ 
(eq. 8)
sin φ sin ϕ + cos φ sin θ cos ϕ 
− sin φ cos ϕ + cos φ sin θ sin ϕ  (eq. 9)

cos φ cos θ