#define TRIG 11
#define ECHO 12
//uint16_t tempo_us=0;
//uint32_t distancia=0;
uint16_t distancia_medida=0;
void setup()
{
// put your setup code here, to run once:
Serial.begin(115200);
Serial.println("Hello, Raspberry Pi Pico!");
pinMode(TRIG, OUTPUT);
digitalWrite(TRIG,0);
pinMode(ECHO, INPUT);
}
uint16_t medicao_distancia(uint8_t trig, uint8_t echo);
void loop()
{
distancia_medida= medicao_distancia(TRIG, ECHO);// Função medição de distância
if(distancia_medida)
{
Serial.println("Distância em milimetros: ");
Serial.println(distancia_medida);
}
else
{
Serial.println("Erro de medicao");
}
delay(40);
}
uint16_t medicao_distancia(uint8_t trig, uint8_t echo)
{
digitalWrite(trig,HIGH);
delayMicroseconds(10);
digitalWrite(trig,LOW);
uint16_t tempo_us = pulseIn(echo,HIGH,8000);
uint32_t distancia=1715*((uint32_t)tempo_us);
distancia=distancia/10000;
return (uint16_t)distancia;
}