| |
;*********** มอเตอร์1ถอยหลัง
มอเตอร์2 หยุด (ซ้าย)
.BRM1SM2
BRES PADR,#6 ; หยุดการทำงานของมอเตอร์ M2
BRES PADR,#7 ; หยุดการทำงานของมอเตอร์ M2
BRES PBDR,#3 ;สั่งให้มอเตอร์ M1ทำงานถอยหลัง
BSET PBDR,#4 ;สั่งให้มอเตอร์ M1ทำงานถอยหลัง
RET ;กลับสู่โปรแกรมหลัก
;**********มอเตอร์1หยุด มอเตอร์2ทำงานถอยหลัง (ขวา)
.BSM1RM2
BRES PADR,#6 ;สั่งให้มอเตอร์ M2ทำงานถอยหลัง
BSET PADR,#7 ;สั่งให้มอเตอร์ M2ทำงานถอยหลัง
BRES PBDR,#3 ; หยุดการทำงานของมอเตอร์ M1
BRES PBDR,#4 ; หยุดการทำงานของมอเตอร์ M1
RET ; กลับสู่โปรแกรมหลัก
;**************โปรแกรมย่อยหน่วงเวลา
.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,#$01 ;00
LD R4,A
.DELA1
LD A,#$01 ;00
.DELA2
INC A
CP A,#$0FF
jrne DELA2
ld A,R4
inc A
ld R4,A
cp a,#$0FF
jrne DELA1
RET
|
Email: basic@basiclite.com 
สายตรง