.FOR4
BSET PADR,#6 ;
BRES PADR,#7 ;
BRES PADR,#0 ; LED1 OFF
BSET PADR,#1 ; LED2 ON
BTJT PADR,#5,FOR4
BRES PADR,#6 ;
BRES PADR,#7 ;
CALL DELAY
BTJT PBDR,#2,FORW
JP START
;************************************
.LEFT
CALL DELAY
.LEFT1
BSET PBDR,#3
BRES PBDR,#4
BTJT PADR,#3,LEFT1
BRES PBDR,#3
BRES PBDR,#4
CALL DELAY
.LEFT2
BRES PADR,#6 ;
BSET PADR,#7 ;
BRES PADR,#0 ; LED1 ON
BSET PADR,#1 ; LED2 OFF
BTJT PADR,#4,LEFT2
BRES PADR,#6 ;
BRES PADR,#7 ;
CALL DELAY
.LEFT3
BRES PBDR,#3
BSET PBDR,#4
BTJT PADR,#2,LEFT3
BRES PBDR,#3
BRES PBDR,#4
CALL DELAY
BTJT PBDR,#0,LEFT
JP START
;************************************
.RIGHT
CALL DELAY
.RIGHT1
BRES PBDR,#3
BSET PBDR,#4
BTJT PADR,#2,RIGHT1
BRES PBDR,#3
BRES PBDR,#4
CALL DELAY
.RIGHT2
BSET PADR,#6 ;
BRES PADR,#7 ;
BSET PADR,#0 ; LED1 OFF
BRES PADR,#1 ; LED2 ON
BTJT PADR,#5,RIGHT2
BRES PADR,#6 ;
BRES PADR,#7 ;
CALL DELAY
.RIGHT3
BSET PBDR,#3
BRES PBDR,#4
BTJT PADR,#3,RIGHT3
BRES PBDR,#3
BRES PBDR,#4
CALL DELAY
BTJT PBDR,#1,RIGHT
JP START
;***************************
.TDELAY LD A,#$01
LD R2,A
.ATDELAY LD A,#$01
LD R1,A
.WAIT2
LD A,#$00 |
|
.WAIT1 INC A
NOP
CP A,#$05
JRNE WAIT1
LD A,R1
INC A
LD R1,A
CP A,#$0FF
JRNE WAIT2
LD A,R2
INC A
LD R2,A
CP A,#$0FF
JRNE ATDELAY
RET
;*************************
.DELAY
LD A,#$0D0 ;00
LD R4,A
.DELA1
LD A,#$0B0 ;00
.DELA2
INC A
CP A,#$0FF
jrne DELA2
ld A,R4
inc A
ld R4,A
cp a,#$0FF
jrne DELA1
RET
;****************************
; Port initialization
;****************************
.INIT
LD A,#$0C3
LD PADDR,A
LD A,#$0FF
LD PAOR, A
LD A,#$18
LD PBDDR,A
LD A,#$0FF
LD PBOR, A
RET
;***********************************
.DUMRET IRET
segment 'vectit'
DC.W DUMRET ; FFE0-FFE1h
DC.W DUMRET ; FFE2-FFE3h
DC.W DUMRET ; FFE4-FFE5h
DC.W DUMRET ; FFE6-FFE7h
DC.W DUMRET ; FFE8-FFE9h
DC.W DUMRET ; FFEA-FFEBh
DC.W DUMRET ; FFEC-FFEDh
DC.W DUMRET ; FFEE-FFEFh
DC.W DUMRET ; FFF0-FFF1h
DC.W DUMRET ; FFF2-FFF3h
DC.W DUMRET ; FFF4-FFF5h
DC.W DUMRET ; FFF6-FFF7h
DC.W DUMRET ; FFF8-FFF9h
DC.W DUMRET ; FFFA-FFFBh
DC.W DUMRET ; FFFC-FFFDh
DC.W MAIN ; FFFE-FFFFh END
|
|
|
Email: basic@basiclite.com 
สายตรง