#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;
}