#include <16F527.h>
#device ADC=8
#use delay(internal=8000000)

int16 distance;          // Defining variables

// Defining the pins

#define trig1 pin_c4     // Change as you wish, can use any pin in the MCU
#define trig2 pin_c5     // Change as you wish, can use any pin in the MCU

#define ECHO pin_c1     // Change as you wish, can use any pin in the MCU
#define ALL_OUT 0
#define ALL_IN 0xff
#FUSES NOWDT

#INT_TIMER0
void timer0_isr()
{
   distance+=0xff;

}

void blink1()
{
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
}

void blink2()
{
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
}

void blink3()
{
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
}
void blink4()
{
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
}
void blink5()
{
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
delay_ms(100);
OUTPUT_HIGH(PIN_c0);
delay_ms(100);
OUTPUT_LOW(PIN_c0);
}

void main()
{

setup_adc(ADC_OFF); 
//set_tris_b( 0x32 );    //PIN 5-INPUT  0b00000010
//et_tris_a( 0x02 );
//set_tris_c( 0x32 );

#byte CM1CON0 = 0x27;
#byte CM2CON0 = 0x28;
#byte VRCON = 0x29;
#byte ANSEL = 0x2A;
#byte OPACON = 0x69;

VRCON = 0x00;
ANSEL = 0x00;
CM1CON0 =0x00;
CM2CON0 =0x00;
OPACON = 0x03;    //ENABLE OPAMP1 & OPAMP2

set_tris_c( 0x02 );

OUTPUT_LOW(PIN_c0);
OUTPUT_LOW(PIN_c4);
OUTPUT_LOW(PIN_c5);
 
delay_ms(1000);               // Boot-up delay, for troubleshooting

setup_timer_0(T0_INTERNAL);   // initiating timer

enable_interrupts(GLOBAL);    // enable GLOBAL INTERRUPTS


while(true)
{

set_tris_c( 0x02 );

output_c(0x10);
delay_us(12);              // sending 10us pulse
#asm
   nop
#endasm
output_c(0x20);
delay_us(12);
#asm
   nop
#endasm
//----------------

output_c(0x10);
delay_us(12);              // sending 10us pulse
#asm
   nop
#endasm
output_c(0x20);
delay_us(12);
#asm
   nop
#endasm

output_c(0x00);

set_tris_c( 0x22 );    //0b00100010

//delay_us(50);

//==============================
while(!input(ECHO))                       // wait for HIGH state of echo pin
{}

set_timer0(0);                           // setting timer zero
distance=0;
enable_interrupts(INT_TIMER0);         //ENABLE TIMER0 INTERRUPTS;
while(input(ECHO))                       // Wait for LOW state of echo pin
{}
disable_interrupts(INT_TIMER0);          // DISABLE t0 INTERRUPTS

distance+=get_timer0();

                         
if(distance<500)
{
blink5();
}

if(distance>499 && distance<1000)
{
blink4();
}

if(distance>999 && distance<1500)
{
blink3();
}


if(distance>1499 && distance<2000 )
{
blink2();
}

if(distance>1999 && distance<2500)
{
blink1();
}
                                     
                                         
delay_ms(1000);


}
}