;-- Data Storage --      
                    ORG   0B6h
_TEMP0              DS    1
_TEMP1              DS    1
I                   DS    1
POS                 DS    1
;-- Equate --            
RA                  =     5
RB                  =     6
RC                  =     7
RD                  =     8
RE                  =     9
TRISA               =     133
TRISB               =     134
TRISC               =     135
TRISD               =     136
TRISE               =     137
ADRES               =     30
ADCON0              =     31
ADCON1              =     159
PIE2                =     141
STAT                =     36
STACK               =     50
SERVO1              =     51
SERVO2              =     52
SERVO3              =     53
SERVO4              =     54
SERVO5              =     55
SERVO6              =     56
SERVO7              =     57
SERVO8              =     58
SPICON              =     60
SPIREG              =     61
IRCON               =     62
IRREG               =     63
;-- Program Start --     
                    ORG   40h
Main                     
                    MOV   POS, #50
                    CALL  SLOW1
                    MOV   POS, #225
                    CALL  SLOW1
                    JMP   Main
SLOW1                     ;--SUB--
                    CMP   SERVO1, POS
                    JAE   _IF0
_IF0A                    
                    MOV   I, SERVO1
_DO0                CMP   I, POS
                    JA    _LOOP0
                    MOV   SERVO1, I
                    DELAY #0, #5
                    INC   I
                    JMP   _DO0
_LOOP0                   
                    JMP   _ELSE0
_IF0                     
                    MOV   I, SERVO1
_DO1                CMP   I, POS
                    JL    _LOOP1
                    MOV   SERVO1, I
                    DELAY #0, #5
                    DEC   I
                    JMP   _DO1
_LOOP1                   
_ELSE0                   
                    RET  
                    END  
;---- Data Text ----