/*
maziar Navahan
STEPPER MOTOR HALF STEP DRIVER
ver 1.00a rev1
Mnavahan@yahoo.com
*/
PUBLIC INISTP ,GORIGHT ,GOLEFT

STPPORT DATA P2
STPLOC DATA 30H

ROT0 EQU 11110111B
ROT1 EQU 11110011B
ROT2 EQU 11111011B
ROT3 EQU 11111001B
ROT4 EQU 11111101B
ROT5 EQU 11111100B
ROT6 EQU 11111110B
ROT7 EQU 11110110B

CSEG AT 500H
STPLOOKUP: DB ROT0,ROT1,ROT2,ROT3,ROT4,ROT5,ROT6,ROT7
;-------------------------------;
;INI STP : ;
;-------------------------------;
INISTP: MOV DPTR,#STPLOOKUP
MOV A,STPLOC
MOVC A,@A+DPTR
MOV STPPORT,A
RET
;-------------------------------;
;GO LEFT ;
;-------------------------------;
GOLEFT: MOV DPTR,#STPLOOKUP
MOV A,STPLOC
JZ GOLEFT_0
DEC A
MOV STPLOC,A
MOVC A,@A+DPTR
MOV STPPORT,A
RET
GOLEFT_0: MOV STPLOC,#7
MOV STPPORT,#ROT7
RET
;-------------------------------;
;GO Right ;
;-------------------------------;
GORIGHT: MOV DPTR,#STPLOOKUP
MOV A,STPLOC
CJNE A,#7,GORIGHT_0
MOV STPLOC,#0
MOV STPPORT,#ROT0
RET
GORIGHT_0: INC A
MOV STPLOC,A
MOVC A,@A+DPTR
MOV STPPORT,A
RET
END