#include <SENSOR ULTRASONICO.

h> #define trig pin_B7 #define echo input(pin_B6) 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 echo while(echo==0); //comienza a contar centimetros hasta que pin echo sea cero while(echo==1){ centimetros++; delay_us(50); } //demora de seguridad y retorna con el valor de centimetros contados delay_ms(50); return(centimetros); } void main() { while(true) { FLOAT distancia; distancia=mide_distancia(); if(distancia<10) { output_high(pin_b5); output_low(pin_b4); } if(distancia>11) { output_high(pin_b4); output_low(pin_b5); } } }