codigo-robo.c

codigo-robo.c

#define THRESHOLD 45

void lancaBola() {
	OnRev(OUT_C, 100);
	Wait(200);
	OnFwd(OUT_C, 100);
	Wait(200);
	Off(OUT_C);
}

void pararRodas() {
	OnRev(OUT_AB, 30);
	Wait(500);
	Off(OUT_AB);
}

void sensor(){
	SetSensorLight(IN_3);
	OnFwd(OUT_AB, 35);
	Wait(100);

	while (true)
	{
		if (Sensor(IN_3) < THRESHOLD)
		{
			pararRodas();
			lancaBola();
			until(Sensor(IN_3) >= THRESHOLD);
		}
	}
}

task main() {
	sensor();
}