int readSonarMax(int samples = 5) { int max = 0; for (int i = 0; i < samples; i++ ) { int reading = readSonar(); if (reading > max) { max = reading; } } return max; }
bool checkSonar(){ if( readSonar() < MIN_OBJECT_DIST ){ return true; } return false; }