Ультразвуковой дальномер HC-SR04

[Admin]

Покопался в интернете, но нигде не нашел кода с фильтрацией принимаемых значений для ультразвукового дальномера HC-SR04. Без фильтра показания очень сильно скачут. Пришлось написать собственный фильтр ложных срабатываний, теперь измерения почти идеальные

Пример кода для Arduino

PHP код:

#include <CyberLib.h>
#define size_buff 5 //размер массива
#define range 1  //предел допустимых значений
uint16_t sensor[size_buff]; //массив
//sizeof(sensor)/2

void setup() 
{
  D14_Out; D14_Low; //пин trig ультразвукового сонара
   D15_In; //пин echo  ультразвукового сонара
  Serial.begin(115200);
}
 
void loop() 
 {
 for (uint8_t i = 0; i < size_buff; ++i) { sensor[i]=GetDistance();}//производим несколько замеров
     uint16_t cm = find_similar(sensor, size_buff, range); //фильтруем показания датчика
     
       Serial.println(cm, DEC); 
 }
 
 uint16_t GetDistance() 
{
  D14_High; delay_us(10);  D14_Low;  //запустить измерение
   uint16_t duration = pulseIn(15,HIGH); //считываем длительность времени прохождения эха  
   delay_ms((50000-duration)/1000); //задержка между посылками
  return duration/58; // переводим в см
}