Implementation/main.c
void park_mode3(uint32_t UT2_avg)
{

	if (UT1_avg < 30)
	{
		park_count4++;
	}
	if (park_count4 > 3) {							// Stop
		wheel(&pwm_motorBA, &pwm_motorBB, BACK, 0); // direction of two motor
		wheel(&pwm_motorAA, &pwm_motorAB, BACK, 0); // direction of two motor
	}

}
// Park mode 3 to finish parking

Park mode 3 to finish parking
Park mode 3 to finish parking
void park_mode3(uint32_t UT2_avg)
{
	if (UT1_avg < 30)
	{
		park_count4++;
	}
	if (park_count4 > 3) {							
		wheel(&pwm_motorBA, &pwm_motorBB, BACK, 0); 
		wheel(&pwm_motorAA, &pwm_motorAB, BACK, 0); 
	}
}
void park_mode3 ( uint32_t UT2_avg ) { if ( UT1_avg < 30 ) { park_count4 ++ ; } if ( park_count4 > 3 ) { wheel ( & pwm_motorBA , & pwm_motorBB , BACK , 0 ) ; wheel ( & pwm_motorAA , & pwm_motorAB , BACK , 0 ) ; } }
Park mode 3 to finish parking
Park mode 3 to finish parking
// Stop
 // direction of two motor
 // direction of two motor
