Servo motor does not work correct

[cesar35]

Hello all well
Here is the code

@ DEVICE PIC16F876A
@ DEVICE PIC16F876A,WDT_ON
@ DEVICE PIC16F876A,PWRT_ON
@ DEVICE PIC16F876A,PROTECT_off
@ DEVICE PIC16F876A,XT_OSC
define OCS 4
ADCON1 = 7
TRISC=%10000000:PORTC=%10000000
TRISA=%11111111:PORTA=%11111111
TRISB=%00000000:PORTB=%00000000

SYMBOL SERVO1=PORTB.0 'SERVO1
SYMBOL RX_INP=PORTC.7 'RF

RX VAR BYTE
POS VAR word

PROG:
serin2 RX_inp,84,500,MODATA,[wait("PC"),RX,DEC POS]

SELECT CASE RX
CASE "1"
GOSUB FRE
CASE "2"
GOSUB TRA
CASE "3"
GOSUB DIR
CASE "4"
GOSUB ESQ
CASE "5"
HIGH PORTB.0
pauseus 1000 + pos
LOW PORTB.0
Pause 16
END SELECT
GOTO PROG

FRE:
PORTC.0 = 0
PORTC.1 = 1
PORTC.2 = 1
PORTC.3 = 0
RETURN
TRA:
PORTC.0 = 1
PORTC.1 = 0
PORTC.2 = 0
PORTC.3 = 1
RETURN
ESQ:
PORTC.0 = 1
PORTC.1 = 0
PORTC.2 = 1
PORTC.3 = 0
RETURN
DIR:
PORTC.0 = 0
PORTC.1 = 1
PORTC.2 = 0
PORTC.3 = 1
RETURN

MODATA:

PORTB.0 = 0
PORTB.1 = 0
PORTB.2 = 0
PORTB.3 = 0
GOTO PROG

[cesar35]

Here the right code.
Please dis me if I'm on track.
sorry

@ DEVICE PIC16F876A
@ DEVICE PIC16F876A,WDT_ON
@ DEVICE PIC16F876A,PWRT_ON
@ DEVICE PIC16F876A,PROTECT_off
@ DEVICE PIC16F876A,XT_OSC
define OCS 4
ADCON1 = 7
TRISC=%10000000:PORTC=%10000000
TRISA=%11111111:PORTA=%11111111
TRISB=%00000000:PORTB=%00000000

SYMBOL SERVO1=PORTB.0 'SERVO1
SYMBOL RX_INP=PORTC.7 'RF

RX VAR BYTE
POS VAR word

PROG:
serin2 RX_inp,84,500,MODATA,[wait("PC"),RX,DEC POS]

SELECT CASE RX
CASE "1"
GOSUB FRE
CASE "2"
GOSUB TRA
CASE "3"
GOSUB DIR
CASE "4"
GOSUB ESQ
CASE "5"
HIGH PORTB.0
pauseus 1000 + pos
LOW PORTB.0
Pause 16
END SELECT
GOTO PROG

FRE:
PORTC.0 = 0
PORTC.1 = 1
PORTC.2 = 1
PORTC.3 = 0
RETURN
TRA:
PORTC.0 = 1
PORTC.1 = 0
PORTC.2 = 0
PORTC.3 = 1
RETURN
ESQ:
PORTC.0 = 1
PORTC.1 = 0
PORTC.2 = 1
PORTC.3 = 0
RETURN
DIR:
PORTC.0 = 0
PORTC.1 = 1
PORTC.2 = 0
PORTC.3 = 1
RETURN

MODATA:

PORTC.0 = 0
PORTC.1 = 0
PORTC.2 = 0
PORTC.3 = 0
GOTO PROG