CavbotRyche
29-01-2015, 18:14
Trying to get the programming in our robot finished and we are struggling. Here is the program. We are new and not very experienced any help or advice would be awesome.
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.RobotDrive;
import edu.wpi.first.wpilibj.RobotDrive.MotorType;
import edu.wpi.first.wpilibj.SampleRobot;
import edu.wpi.first.wpilibj.Timer;
/**
* This is a demo program showing how to use Mecanum control with the RobotDrive class.
*/
public class Buttontest extends SampleRobot {
RobotDrive robotDrive;
Joystick stick;
// Channels for the wheels
final int frontLeftChannel = 0;
final int rearLeftChannel = 1;
final int frontRightChannel = 2;
final int rearRightChannel = 3;
// The channel on the driver station that the joystick is connected to
final int joystickChannel = 3;
private Object conveyorMotor;
private Object joystick;
private Object set;
public Buttontest() {
robotDrive = new RobotDrive(frontLeftChannel, rearLeftChannel, frontRightChannel, rearRightChannel);
robotDrive.setExpiration(0.1);
stick = new Joystick(joystickChannel);
}
/**
* Runs the motors with Mecanum drive.
*/
public void operatorControl() {
robotDrive.setSafetyEnabled(true);
while (isOperatorControl() && isEnabled()) {
// Use the joystick X axis for lateral movement, Y axis for forward movement, and Z axis for rotation.
// This sample does not use field-oriented drive, so the gyro input is set to zero.
robotDrive.arcadeDrive(-stick.getY(), -stick.getX());
Timer.delay(0.005); // wait 5ms to avoid hogging CPU cycles
}
}
//Conveyor Belt
boolean belt = false;
boolean toggle = true;
if (toggle && Button) {
toggle = false;
if (belt) {
belt= false;
conveyorMotor.set(1);
}else{
belt= true;
conveyorMotor.set(0);
}
}else if(belt == FALSE){
toggle = true;
}
import edu.wpi.first.wpilibj.Joystick;
import edu.wpi.first.wpilibj.RobotDrive;
import edu.wpi.first.wpilibj.RobotDrive.MotorType;
import edu.wpi.first.wpilibj.SampleRobot;
import edu.wpi.first.wpilibj.Timer;
/**
* This is a demo program showing how to use Mecanum control with the RobotDrive class.
*/
public class Buttontest extends SampleRobot {
RobotDrive robotDrive;
Joystick stick;
// Channels for the wheels
final int frontLeftChannel = 0;
final int rearLeftChannel = 1;
final int frontRightChannel = 2;
final int rearRightChannel = 3;
// The channel on the driver station that the joystick is connected to
final int joystickChannel = 3;
private Object conveyorMotor;
private Object joystick;
private Object set;
public Buttontest() {
robotDrive = new RobotDrive(frontLeftChannel, rearLeftChannel, frontRightChannel, rearRightChannel);
robotDrive.setExpiration(0.1);
stick = new Joystick(joystickChannel);
}
/**
* Runs the motors with Mecanum drive.
*/
public void operatorControl() {
robotDrive.setSafetyEnabled(true);
while (isOperatorControl() && isEnabled()) {
// Use the joystick X axis for lateral movement, Y axis for forward movement, and Z axis for rotation.
// This sample does not use field-oriented drive, so the gyro input is set to zero.
robotDrive.arcadeDrive(-stick.getY(), -stick.getX());
Timer.delay(0.005); // wait 5ms to avoid hogging CPU cycles
}
}
//Conveyor Belt
boolean belt = false;
boolean toggle = true;
if (toggle && Button) {
toggle = false;
if (belt) {
belt= false;
conveyorMotor.set(1);
}else{
belt= true;
conveyorMotor.set(0);
}
}else if(belt == FALSE){
toggle = true;
}