So I updated my code, but nothing seems to be happening! Here's the updated version:
Code:
package edu.wpi.first.wpilibj.templates;
import edu.wpi.first.wpilibj.GenericHID;
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.Relay;
import edu.wpi.first.wpilibj.RobotDrive;
import edu.wpi.first.wpilibj.SimpleRobot;
import edu.wpi.first.wpilibj.Talon;
import edu.wpi.first.wpilibj.Timer;
public class RobotTemplate extends SimpleRobot {
RobotDrive myDrive;
Joystick moveStick, rotateStick;
Talon backRight, backLeft, frontRight, frontLeft;
Relay relay;
public void robotInit() {
frontLeft = new Talon(1);
backLeft = new Talon(2);
backRight = new Talon(3);
frontRight = new Talon(4);
relay = new Relay(1);
//myDrive = new RobotDrive(frontLeft, backLeft, frontRight, backRight);
myDrive = new RobotDrive(backLeft, backRight, frontLeft, frontRight);
moveStick = new Joystick(2);
rotateStick = new Joystick(1);
}
/**
* This function is called once each time the robot enters autonomous mode.
*/
/**
* This function is called once each time the robot enters operator control.
*/
public void operatorControl() {
while (isOperatorControl() && isEnabled()) {
myDrive.mecanumDrive_Cartesian(moveStick.getY(), rotateStick.getX(), moveStick.getX(), 0);
if (rotateStick.getTrigger(GenericHID.Hand.kLeft) && isEnabled()) {
relay.set(Relay.Value.kOff);
relay.setDirection(Relay.Direction.kForward);
}
}
//mecanumDrive_Polar(moveStick.getY(), moveStick.getX(), rotateStick.getX());
Timer.delay(0.1);
}
}
/**
* This function is called once each time the robot enters test mode.
*/