I'm unable to control a servo wireless
someone can help me
need to control 2 motor and a servo motor.
THANK YOU

A VAR BYTE
B VAR BYTE
C VAR BYTE
D VAR BYTE
E VAR BYTE
X VAR BYTE


PAUSE 900
lcdout $FE,1,"P1 P2 P3 P4"

PROG:
GOSUB LCD
ADCIN 0,A
ADCIN 1,B
ADCIN 2,C
ADCIN 3,D
ADCIN 4,E:X=(E+20)
PAUSEUS 50
hserout ["PC",A,B,C,D,X]
GOTO PROG

LCD:
lcdout $FE,$C0,dec3 A," ",dec3 B," ",dec3 C," ",DEC D," "
pause 200
RETURN


A VAR BYTE
B VAR BYTE
C VAR BYTE
D VAR BYTE
E VAR BYTE


PROG:
hSerIn [WAIT("PC"),A,B,C,D,E]
if (A>160) THEN FRE
IF (A<100) THEN TRA
IF (B>160) THEN DIR
IF (B<100) THEN ESQ

pulsout PORTB.0,E 'SERVO MOTOR


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

FRE:
PORTC.0 = 1
PORTC.1 = 0
PORTC.2 = 0
PORTC.3 = 1
PORTC.5 = 1
GOTO PROG

TRA:
PORTC.0 = 0
PORTC.1 = 1
PORTC.2 = 1
PORTC.3 = 0
PORTC.5 = 1
GOTO PROG

DIR:
PORTC.0 = 1
PORTC.1 = 0
PORTC.2 = 1
PORTC.3 = 0
PORTC.5 = 1
GOTO PROG

ESQ:
PORTC.0 = 0
PORTC.1 = 1
PORTC.2 = 0
PORTC.3 = 1
PORTC.5 = 1
GOTO PROG