Опрос датчиков

dt=5
kodl=0
OUT &H300,kodl
OUT &H301,kodl
OUT &H301,kodl
m1:
OUT &H300,128
OUT &H300,1
OUT &H301,64
tn=TIMER

DEFINT A-Z
DIM AltTim AS SINGLE
DIM dt AS SINGLE, dts  AS SINGLE
DIM KODD, KODU, erst
DECLARE SUB SubOut (kod)
 
erst = 0
dt = 5
 
DO
a$ = INKEY$
LOOP WHILE a$ <> ""
 
DO
IF ((TIMER - AltTim) >= dt) OR NOT erst THEN
  AltTim = TIMER
  IF AltTim >= 3.402823E+38 - dt THEN AltTim = AltTim - 3.402823E+38
  erst = -1
  DEF SEG = VARSEG(KODD)
  POKE VARPTR(KODD), INP(&H300)
  POKE VARPTR(KODD) + 1, INP(&H301)
  DEF SEG
  KODD = KODD AND &H8102
  IF KODD = &H8102 THEN
     KODU = &HC102
  ELSE
     KODU = KODD
  END IF
  SubOut (KODU)
  dts = TIMER - AltTim
END IF
a$ = INKEY$
LOOP UNTIL a$ <> ""
 
END
 
SUB SubOut (kod)
DEF SEG = VARSEG(kod)
 OUT &H300, PEEK(VARPTR(kod))
 OUT &H301, PEEK(VARPTR(kod) + 1)
DEF SEG
END SUB

CLS
t0=TIMER
dt=5
kodl=0
out&300,0
out&301,0
M1:
CLS
kod1=INP(&300)
kod2=INP(&301)
maska1=1
maska2=128
maska3=2
rezoult1=1 AND kod1
rezoult2=128 AND kod1
rezoult3=2 AND kod2
 
IF rezoult1=1 THEN d1=1 ELSE d1=0
IF rezoult2=128 THEN d2=1 ELSE d1=0
IF rezoult3=2 THEN d3=1 ELSE d1=0
 
n=d1+d2+d3
IF n>2 THEN GOTO 20 ELSE 10
 
10
kodu1=rezoult1+rezoult2
kodu2=rezoult3
GOTO 30
20
kodu1=rezoult1+rezoult2
kodu2=rezoult3+32
 
ts=TIMER
PRINT ts-t0
 
30
out&300,kodu1
out&301,kodu2
m4:IF ((TIMER-tn)>dt) THEN GOTO m1 ELSE GOTO m4
END