parent
9ec69ad78f
commit
bba5c45c0f
@ -75,6 +75,7 @@ READPIPS INHINT
|
||||
TS MPAC +1
|
||||
TS MPAC +4
|
||||
TS MPAC +6
|
||||
|
||||
VECMODE TCF VMODE
|
||||
|
||||
# FORCE TP SIGN AGREEMENT IN MPAC:
|
||||
@ -146,7 +147,7 @@ TPMODE CAF ONE # MODE IS TP.
|
||||
|
||||
INCRCDUS CAF LOCTHETA
|
||||
TS BUF # PLACE ADRES(THETA) IN BUF.
|
||||
CAE MPAC # INCREMENT IN 1'S COMPL.
|
||||
CAE MPAC # INCREMENT IN 1S COMPL.
|
||||
TC CDUINC
|
||||
|
||||
INCR BUF
|
||||
@ -161,32 +162,32 @@ INCRCDUS CAF LOCTHETA
|
||||
|
||||
LOCTHETA ADRES THETAD
|
||||
|
||||
# THE FOLLOWING ROUTINE INCREMENTS IN 2'S COMPLEMENT THE REGISTER WHOSE ADDRESS IS IN BUF BY THE 1'S COMPL.
|
||||
# QUANTITY FOUND IN TEM2. THIS MAY BE USED TO INCREMENT DESIRED IMU AND OPTICS CDU ANGLES OR ANY OTHER 2'S COMPL.
|
||||
# THE FOLLOWING ROUTINE INCREMENTS IN 2S COMPLEMENT THE REGISTER WHOSE ADDRESS IS IN BUF BY THE 1S COMPL.
|
||||
# QUANTITY FOUND IN TEM2. THIS MAY BE USED TO INCREMENT DESIRED IMU AND OPTICS CDU ANGLES OR ANY OTHER 2S COMPL.
|
||||
# (+0 UNEQUAL TO -0) QUANTITY. MAY BE CALLED BY BANKCALL/SWCALL.
|
||||
|
||||
CDUINC TS TEM2 # 1'S COMPL. QUANT. ARRIVES IN ACC. STORE IT
|
||||
CDUINC TS TEM2 # 1S COMPL.QUANT. ARRIVES IN ACC. STORE IT
|
||||
INDEX BUF
|
||||
CCS 0 # CHANGE 2'S COMPLE. ANGEL (IN BUF) INTO 1'S
|
||||
CCS 0 # CHANGE 2S COMPLE. ANGLE(IN BUF) INTO 1S
|
||||
AD ONE
|
||||
TCF +4
|
||||
AD ONE
|
||||
AD ONE # OVEFLOW HERE IF 2'S COMPL. IS 180 DEG.
|
||||
AD ONE # OVEFLOW HERE IF 2S COMPL. IS 180 DEG.
|
||||
COM
|
||||
|
||||
AD TEM2 # SULT MOVES FROM 2ND TO 3D QUAD.(OR BACK)
|
||||
CCS A # BACK TO 2'S COMPL.
|
||||
CCS A # BACK TO 2S COMPL.
|
||||
AD ONE
|
||||
TCF +2
|
||||
COM
|
||||
TS TEM2 # STORE 14-BIT QUANTITY WITH PRESENT SIGN
|
||||
TS TEM2 # STORE 14BIT QUANTITY WITH PRESENT SIGN
|
||||
TCF +4
|
||||
INDEX A # SIGN.
|
||||
CAF LIMITS # FIX IT,BY ADDING IN 37777 OR 40000
|
||||
AD TEM2
|
||||
|
||||
INDEX BUF
|
||||
TS 0 # STORE NEW ANGLE IN 2'S COMPLEMENT.
|
||||
TS 0 # STORE NEW ANGLE IN 2S COMPLEMENT.
|
||||
TC Q
|
||||
|
||||
# Page 1512
|
||||
@ -200,8 +201,8 @@ PULSEIMU INDEX FIXLOC # ADDRESS OF GYRO COMMANDS SHOULD BE IN X1
|
||||
|
||||
# Page 1513
|
||||
# EACH ROUTINE TAKES A 3X3 MATRIX STORED IN DOUBLE PRECISION IN A FIXED AREA OF ERASABLE MEMORY AND REPLACES IT
|
||||
# WITH THE TRANSPOSE MATRIX. TRANSP1 USES LOCATIONS XNB+0,+1 THROUGH XNB+16D,+17D AND TRANSP2 USES LOCATIONS
|
||||
# XNB1+0,+1 THROUGH XNB1+16D,+17D. EACH MATRIX IS STORED BY ROWS.
|
||||
# WITH THE TRANSPOSE MATRIX. TRANSP1 USES LOCATIONS XNB+0,+1 THROUGH XNB+16D, 17D AND TRANSP2 USES LOCATIONS
|
||||
# XNB1+0,+1 THROUGH XNB1+16D, 17D. EACH MATRIX IS STORED BY ROWS.
|
||||
|
||||
XNBEB ECADR XNB
|
||||
XNB1EB ECADR XNB1
|
||||
@ -222,6 +223,8 @@ TRANSP1 CAF XNBEB
|
||||
DXCH XNB +14D
|
||||
DXCH XNB +10D
|
||||
TCF DANZIG
|
||||
|
||||
|
||||
EBANK= XNB1
|
||||
|
||||
TRANSP2 CAF XNB1EB
|
||||
|
Loading…
Reference in New Issue
Block a user