Código Arduíno para Sensor ultrassônico

Código Arduíno para Sensor ultrassônico


Segue abaixo o código que foi utilizado nos testes realizados com o sensor, o mesmo usa a biblioteca "Ultrasonic.h", o mesmo código faz um tratamento dos dados recebidos, pegando 4 valores e fazendo uma media dos mesmos.


Code:


#include "Ultrasonic.h"
Ultrasonic ultrasonic(12,13); // TRIG = pino 12     ECHO = pino 13
void setup() {
  Serial.begin(9600);
  pinMode(8,OUTPUT);
}
void loop()
{
tratamento();
}
void tratamento(){
  int distemporaria=0;
  int med[4],i,j,sum;
  delay(5);
  for(i=0;i<4;i++){
    med[i]= ultrasonic.Ranging(CM);
    sum+=med[i];
  }
  distemporaria = sum/4 ;
  distancia = distemporaria;
  if (distemporaria < 500){
    distancia = distemporaria;
  }
  else{ }

Serial.print("CM: ");
Serial.println(distancia);
}