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