// no es autoria mia, solo estoy difundiendo la palabra.//********************************************************************// Cabecera del programa, depende del pic que uses//********************************************************************//********************************************************************// Funcion de mide distancia de sensor ultrasonico#define trig pin_c6#define echo input(pin_c7)int16 mide_distancia(void){int16 centimetros=0;//pulso de disparo:output_high(trig);delay_us(50);output_low(trig);//espera flanco de subida por el pin echowhile(echo==0);//comienza a contar centimetros hasta que pin echo sea cerowhile(echo==1){centimetros++;delay_us(58);}//demora de seguridad y retorna con el valor de centimetros contadosdelay_ms(50);return(centimetros);}//********************************************************************//********************************************************************// Funcion principal del programavoid main( void ){int16 distancia;int8 i;lcd_init(); // inicializa lcdwhile (true){ // lazo infinitodistancia=mide_distancia(); // AQUI USAMOS NUESTRA PODEROSA FUNCION!!!lcd_gotoxy(1,1);if(distancia>500){ // si lectura > 500cm entonces no es valida, osea no hay objetolcd_putc('\f'); // Borra LCDprintf(lcd_putc,"NO DETECTED!");output_low(pin_c0);}else{ // si distancia fue < 500cm es una distancia valida y la imprime en LCDprintf(lcd_putc,"%03lucm ",distancia);output_high(pin_c0);}}// cierra lazo infinito}// cierra main//********************************************************************************************************************************