#include "WPILib.h"
#include "Compressor.h"

class RobotDemo : public SimpleRobot
{
	RobotDrive myRobot;
	RobotDrive myRobot2;
	RobotDrive myRobot3;
	Joystick stick; 
	Joystick stick2;
   	 Joystick stick3;
  	  Compressor compressor;

public:
	RobotDemo(void):
		myRobot(3, 4),	
		myRobot2(2, 1),
		myRobot3(5, 6),
		stick(1),
		stick2(2),
		stick3(3),
		compressor(1, 8)
		
	{
		GetWatchdog().SetExpiration(0.1);
	}

	void Autonomous(void)
	{
		GetWatchdog().SetEnabled(false);
		myRobot.Drive(-0.5, 0.0); 	
		Wait(1.0); 	
		myRobot.Drive(0.0, 0.0);
		myRobot3.Drive(0.5, 0.0);
		Wait(2.0);
		 	
	}

	void OperatorControl(void)
	{
		GetWatchdog().SetEnabled(true);
		while (IsOperatorControl())
		{
			GetWatchdog().Feed();
			myRobot.TankDrive(stick2.GetY(), stick3.GetY()); 
			Wait(0.005);				
			myRobot2.TankDrive(stick2.GetY(), stick3.GetY());
			Wait(0.005);
			myRobot3.TankDrive(stick.GetY(), stick.GetX());
			Wait(0.005);
			compressor.Start();
			
		}
	}
};