Example #1
0
void loop()		
{
	char cmd = 'N';  //NULL

	if(Serial.available())
	{
		cmd = (char)Serial.read();
		printf("CMD = %c(%d) \n", cmd, cmd);
	}
	switch(cmd)
	{
	case 'L':
		servoAngle(LEFT, 2000);
		break;
	case 'R':
		servoAngle(RIGHT, 2000);
		break;
	case 'D':
		servoAngle(LEFT, 1000);
		servoAngle(RIGHT, 1000);
		break;
	default:
		break;			
	}

	delay(200);
}
Example #2
0
void setup()
{
	pinMode(LEFT, OUTPUT);
	pinMode(RIGHT, OUTPUT);	
	servoAngle(LEFT, 1000);
	servoAngle(RIGHT, 1000);	
	
	Serial.begin(9600);
}
Example #3
0
task main()
{
	initializeRobot();
	while(true)
	{
		getJoystickSettings(joystick);

		main_wheel(joystick.joy1_x1, joystick.joy1_y1);
		lift(joystick.joy2_y1);

		if ( joy2Btn(8)==1 )
			elevMoveFree(joystick.joy2_y2);
	  else
			elevMove(joystick.joy2_y2);

		resetElevEncoder(joy2Btn(3));

		servoInitial(joy2Btn(2));
		servoAngle (joy2Btn(4));
		displayMessage(joy2Btn(1));

		wait1Msec(TIME_INTERVAL);
	}

}