ryan/Apollo-11
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fix: (Issue #569) page 0346

Browse Source
This commit is contained in:
Sudhish2607 2020-10-28 19:31:37 -05:00
parent a755d18010
commit 783918f64b
1 changed files with 29 additions and 27 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

56
Luminary099/ATTITUDE_MANEUVER_ROUTINE.agc
View File

@ -227,53 +227,55 @@
# 7 # 7
# Page 346 # Page 346
# M = -SINY SINZ SINX + COSY COSX # M = -SINY SINZ SINX + COSY COSX
# 8 # 8
# #
# WHERE X = OUTER GIMBAL ANGLE # WHERE X = OUTER GIMBAL ANGLE
# Y = INNER GIMBAL ANGLE # Y = INNER GIMBAL ANGLE
# Z = MIDDLE GIMBAL ANGLE # Z = MIDDLE GIMBAL ANGLE
# #
# THE INTERPRETATION OF THIS MATRIX IS AS FOLLOWS: # THE INTERPRETATION OF THIS MATRIX IS AS FOLLOWS
# #
# IF A , A , A REPRESENT THE COMPONENTS OF A VECTOR IN S/C AXES THEN THE COMPONENTS OF THE SAME VECTOR IN # IF A , A , A REPRESENT THE COMPONENTS OF A VECTOR IN S/C AXES THEN THE COMPONENTS OF THE SAME VECTOR IN
# X Y Z # X Y Z
# STABLE MEMBER AXES (B , B , B ) ARE # STABLE MEMBER AXES (B , B , B ) ARE
# X Y Z # X Y Z
# #
# [ B ] [ A ] # (B ) (A )
# [ X ] [ X ] # ( X) ( X)
# [ ] [ ] # ( ) ( )
# [ B ] * [ A ] # ( ) * ( )
# [ Y ] = M [ Y ] # (B ) = M (A )
# [ ] [ ] # ( Y) ( Y)
# [ B ] [ B ] # ( ) ( )
# [ Z ] [ Z ] # (B ) (A )
# ( Z) ( Z)
# #
# THE SUBROUTINE WILL STORE THIS MATRIX IN SEQUENTIAL LOCATIONS OF ERASABLE MEMORY AS SPECIFIED BY THE CALLING # THE SUBROUTINE WILL STORE THIS MATRIX IN SEQUENTIAL LOCATIONS OF ERASABLE MEMORY AS SPECIFIED BY THE CALLING
# * # *
# PROGRAM. TO DO THIS THE CALLING PROGRAM MUST FIRST LOAD X2 WITH THE COMPLEMENT OF THE STARTING ADDRESS FOR M. # PROGRAM. TO DO THIS THE CALLING PROGRAM MUST FIRST LOAD X2 WITH THE COMPLEMENT OF THE STARTING ADDRESS FOR M.
# #
# INTERNALLY, THE ROUTINE USES THE FIRST 16 LOCATIONS OF THE PUSH DOWN LIST, ALSO STEP REGISTER S1 AND INDEX # INTERNALLY, THE ROUTINE USES THE FIRST 16 LOCATIONS OF THE PUSH DOWN LIST, ALSO STEP REGISTER S1 AND INDEX
# REGISTER X2. # REGISTER X2.
# #
# DCM TO CDU # DCM TO CDU
# ---------- # ----------
# * # *
# THIS ROUTINE EXTRACTS THE CDU ANGLES FROM A DIRECTION COSINE MATRIX (M SCALED BY 2) RELATING S/C AXIS TO # THIS ROUTINE EXTRACTS THE CDU ANGLES FROM A DIRECTION COSINE MATRIX (M SCALED BY 2) RELATING S/C AXIS TO
# * # *
# STABLE MEMBER AXES. X1 MUST CONTAIN THE COMPLEMENT OF THE STARTING ADDRESS FOR M. THE SUBROUTINE LEAVES THE # STABLE MEMBER AXES. X1 MUST CONTAIN THE COMPLEMENT OF THE STARTING ADDRESS FOR M. THE SUBROUTINE LEAVES THE
# CORRESPONDING GIMBAL ANGLES IN V(MPAC) AS DOUBLE PRECISION 1'S COMPLEMENT ANGLES SCALED BY 2PI. THE FORMULAS # CORRESPONDING GIMBAL ANGLES IN V(MPAC) AS DOUBLE PRECISION 1:S COMPLEMENT ANGLES SCALED BY 2PI. THE FORMULAS
# FOR THIS CONVERSION ARE # FOR THIS CONVERSION ARE
# #
# Z = ARCSIN (M ) # Z = ARCSIN (M )
# 3 # 3
# #
# Y = ARCSIN (-M /COSZ) # Y = ARCSIN (-M /COSZ)
# 6 # 6
# #
# IF M IS NEGATIVE, Y IS REPLACED BY PI SGN Y - Y. # IF M IS NEGATIVE, Y IS REPLACED BY PI SGN Y - Y
# 0 # 0
# Page 347 # Page 347
# X = ARCSIN (-M /COSZ) # X = ARCSIN (-M /COSZ)
# 5 # 5