Servo motor does not work correct

[cesar35]

Hello
Can someone help me.
I can not control a servo motor he is without direction.
here's codgo I'm using.
In the PC program I have a range between 700 a 2300.
Thank you.
RX VAR BYTE
POS VAR BYTE
X1 VAR BYTE

PROG:
serin2 RX_inp,16468,[wait("PC"),RX,POS]

IF RX = "A" THEN FRE
IF RX = "B" THEN TRA
IF RX = "C" THEN ESQ
IF RX = "D" THEN DIr
if RX = "E" THEN PAR
IF RX = "X" THEN SERV
GOTO PROG

FRE:
PORTB.0 = 0
PORTB.1 = 1
PORTB.2 = 1
PORTB.3 = 0
GOTO PROG
TRA:
PORTB.0 = 1
PORTB.1 = 0
PORTB.2 = 0
PORTB.3 = 1
GOTO PROG
ESQ:
PORTB.0 = 1
PORTB.1 = 0
PORTB.2 = 1
PORTB.3 = 0
GOTO PROG
DIR:
PORTB.0 = 0
PORTB.1 = 1
PORTB.2 = 0
PORTB.3 = 1
GOTO PROG

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

SERV:
high SERVO1
pauseus X1*10:X1 = pos
low SERVO1
GOTO PROG