fix: (Issue #569) page 0359

This commit is contained in:
Sudhish2607 2020-10-29 02:00:47 -05:00
parent 91d19ab387
commit 1a797dbe09

View file

@ -805,34 +805,34 @@ LOOPSIN SLOAD* RTB
# Page 359
DLOAD
DMP SL1 # (PUSH UP 7)
DMP SL1 # (PUSH UP 7)
8D
PDDL DMP # (PD7 COS(PHI)SIN(THETA)SIN(PSI)) SCALE 4
PDDL DMP # (PD7 COS(PHI)SIN(THETA)SIN(PSI)) SCALE 4
6
0
DAD SL1 # (PUSH UP 7)
DAD SL1 # (PUSH UP 7)
STADR # C7=COS(PHI)SIN(THETA)SIN(PSI)
STORE 14D,2 # +COS(THETA)SIN(PHI)
STORE 14D,2 # +COS(THETA)SIN(PHI)
DLOAD
DMP SL1 # (PUSH UP 6)
DMP SL1 # (PUSH UP 6)
8D
PDDL DMP # (PD6 SIN(THETA)SIN(PHI)SIN(PSI)) SCALE 4
PDDL DMP # (PD6 SIN(THETA)SIN(PHI)SIN(PSI)) SCALE 4
6
2
DSU SL1 # (PUSH UP 6)
DSU SL1 # (PUSH UP 6)
STADR
STORE 16D,2 # C8=-SIN(THETA)SIN(PHI)SIN(PSI)
RVQ # +COS(THETA)COS(PHI)
RVQ # +COS(THETA)COS(PHI)
# CALCULATION OF THE MATRIX DEL......
#
# * * __T *
# DEL = (IDMATRIX)COS(A)+UU (1-COS(A))+UX SIN(A) SCALED 1
# _
# WHERE U IS A UNIT VECTOR (DP SCALED 2) ALONG THE AXIS OF ROTATION.
# A IS THE ANGLE OF ROTATION (DP SCALED 2)
# _
# UPON ENTRY, THE STARTING ADDRESS OF U IS COF, AND A IS IN MPAC
# * * --T *
# DEL = (IDMATRIX)COS(A)+UU (1-COS(A))+UX SIN(A) SCALED 1
# -
# WHERE U IS A UNIT VECTOR (DP SCALED 2) ALONG THE AXIS OF ROTATION.
# A IS THE ANGLE OF ROTATION (DP SCALED 2)
# -
# UPON ENTRY THE STARTING ADDRESS OF U IS COF, AND A IS IN MPAC
DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
0
@ -842,7 +842,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
BDSU BOVB
DPHALF
SIGNMPAC
PDDL # PDA = 1-COS(A)
PDDL # PD4 = 1-COS(A)
# COMPUTE THE DIAGONAL COMPONENTS OF DEL
@ -853,6 +853,7 @@ DELCOMP SETPD PUSH # MPAC CONTAINS THE ANGLE A
2
BOVB
SIGNMPAC
# Page 360
STODL KEL # UX UX(1-COS(A)) +COS(A) $1
COF +2