Example #1
0
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);
	}

}
Example #2
0
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;
	
}