MarcFriedenberg.com

#define SERVO servo0
#define SPEED 10
#define OFF 0

int j=0;
int num;

void main()
{
	init_expbd_servos(1);
	start();
}
void start()
{
	servo0=3800;
	printf("I am ready...\n");
	while (!start_button()) {}
	while (start_button()) {}
	play();
}

void play()
{
	int angle;
	while (start_button()) {}
	motor(3,8);
	while (1)
	{
		for (angle=3500;angle<=4100;angle+=60)
		{
			SERVO=angle;
			sleep(.5);
			check();
		}
		if (j=2)
			j=0;
		else
			j++;
		for (angle=4100;angle>=3500;angle-=60)
		{
			SERVO=angle;
			sleep(.5);
			check();
		}
		if (j=2)
			j=0;
		else
			j++;
	}
}

void check()
{
		num=abs((int)mseconds()%(int)seconds());
		printf("%d\n", num);
		sleep(.2);

		if (num<15)
		{
			motor (0,20);
			if (j=1)
				motor(1,OFF);
		}
		else if (num>15 && num<35)
		{
			motor (1,SPEED);
			if (j=2)
				motor(2,OFF);
		}
		else
		{
			motor (2,SPEED);
			if (j=0)
				motor(0,OFF);
		} 

}	

int abs(int num)
{
	if (num>0)
		return num;
	else
		return num*-1;
}