void stagnation_recovery(double distance_sensors_value[8], int DIST_THRESHOLD) { if (align_counter < 2) // Align { printf("Realigning\n"); align_counter = align_counter + 1; realign(distance_sensors_value); } else if(align_counter > 0)// Reposition { printf("Finding new spot\n"); LED_blink(); find_new_spot(distance_sensors_value, DIST_THRESHOLD); } }
int stagnation_recovery(double distance_sensors_value[8], int DIST_THRESHOLD) { int stagnation = get_stagnation_state(); if(stagnation){ if (align_counter < 2) // Align { align_counter = align_counter + 1; realign(distance_sensors_value); } else if(align_counter > 0)// Reposition { LED_blink(); find_new_spot(distance_sensors_value, DIST_THRESHOLD); } } return stagnation; }