Problemas codigo

[odraude]

Hola, soy nuevo en esto de los pics y me estoy iniciando con la programacion en c. Ahorita estoy realizando un proyecto final, el cual es una pluma de estacionamiento con lectura de codigos qr, pero estoy atorado en el codigo, ya que a mi parecer esta bien pero solo manda una señal intermitente por RB0 y RB1 adjunto mi codigo espero me puedan ayudar, estoy programando en ccs.

Código: [Seleccionar]

#include <16f887.h>

#fuses INTRC_IO,NOWDT,NOPROTECT,NOPUT,NOMCLR,NOCPD,NOBROWNOUT,NOIESO,NOFCMEN,NOWRT,BORV40,NOLVP             

#use delay(int=8M)

#use rs232(baud=9600, xmit=PIN_C6, rcv=PIN_C7)



#use fast_io(A)

#use fast_io(B)

#byte porta = 5

#byte portb = 6



void main()

{

int c;

set_tris_a(0xFF);      //PUERTOS 'A' COMO ENTRADAS

set_tris_b(0x00);      //PUERTOS 'B' COMO SALIDAS

porta=0b11111111;      //TODOS LOS PUERTOS A COMO ENTRADAS

portb=0b00000000;       //TODOS LOS PUERTOS B COMO SALIDAS



do

{

c=fgetc();                       //constante enviada por puerto serial



if (input(PIN_A0))                   //accionamiento manual

goto pase;

if(c==48) // arranque



pase:        output_toggle(PIN_B3);//LED=1



subepluma:   output_high(PIN_B0);       //levanta la pluma

                      output_low(PIN_B1);

                      delay_ms(240);



frena:       output_low(PIN_B0);             //frenado en lo alto

                      output_low(PIN_B1);

                      if(!input(PIN_A1))goto pausa;    //sensado de vehiculo mientras no pase por la pluma

                      delay_ms(2000);



continua:



bajapluma:   output_high(PIN_B1);                       //baja la pluma

                      output_low(PIN_B0);

                      delay_ms(180);output_low(PIN_B3);               //LED=0



pausa:                if(!input(PIN_A1))goto continua;                //pausa mientras el vehiculo no pase

                      goto pausa;

}

while(true);

}