cảm biến siêu âm và PIC!!!!!!!!!!!!

[chungpmth]

#include <16f877a.h>
#include <defs_16f877a.h>
#include <def_877a.h>


#use delay(clock=20000000)
#fuses HS,NOWDT,PUT,NOPROTECT,NOLVP

#include <lcd_lib_4bit.c>
float getvar = 0, distance = 0;
int1 has_echo = 0, trg = 0;

void trigger(); //t?o trigger

#INT_CCP1
void ccp1_isr()
{
if(!trg) {
//Khi có xung echo c?nh lên
set_timer1(0); //Reset timer1 v? 0
setup_ccp1(CCP_CAPTURE_FE); //chuy?n sang dò xung c?nh xu?ng
trg = 1;
}
else
{
//Khi có xung echo c?nh xu?ng
getvar = get_timer1(); //??c giá tr? timer1 ngay khi có xung echo c?nh xu?ng
distance = ((getvar /111)*3.2-14.7);//(getvar - 485)/28.3; // S? li?u d?a theo k?t qu? ?o th?c t?
has_echo = 1;
disable_interrupts(GLOBAL);
output_high(pin_B2);
}
}



void main ()
{

LCD_init();

setup_timer_1(T1_INTERNAL|T1_DIV_BY_8);


setup_ccp1(CCP_CAPTURE_RE);
enable_interrupts(INT_CCP1); // Cho phép ng?t khi CCP1 có tín hi?u
trg = 0;
has_echo = 0;
TRISC2 = 0; //set chân RC2 làm output
RC2 = 1; //trigger
delay_us(20);
RC2 = 0;
TRISC2 = 1; //set chân RC2 làm input
setup_ccp1(CCP_CAPTURE_RE);
enable_interrupts(GLOBAL);
while (1)
{

//trigger();
while(!has_echo);
lcd_putcmd(0xc0);
printf(lcd_putchar,"K/C:%6.2f", distance);
delay_us(100);
//trigger();
}
}
void trigger()

{
trg = 0;
has_echo = 0;
TRISC2 = 0; //set chân RC2 làm output
RC2 = 1; //trigger
delay_us(20);
RC2 = 0;
TRISC2 = 1; //set chân RC2 làm input
setup_ccp1(CCP_CAPTURE_RE);
enable_interrupts(GLOBAL);
}

bạn ơi xem giúp mình cái code này với
mình chạy thử mà lcd nó không hiện lên gì cả?
mh test rồi không phải là do LCD
mình viết trương trình này là để đọc cảm biến siêu âm sử dụng mode2 của nó
bạn giúp mình với nhá!