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