Mr.Roboto3335
17-01-2015, 10:24
I've been having some trouble getting the motor controllers to connect to the roboRio. When I enable teleop, the motor controllers still flash as if teleop was disabled. I was wondering if this was a wiring or a software issue. Here's my code.
package org.usfirst.frc.team3335.robot;
/*----------------------------------------------------------------------------*/
/* Copyright (c) FIRST 2008. All Rights Reserved. */
/* Open Source Software - may be modified and shared by FRC teams. The code */
/* must be accompanied by the FIRST BSD license file in the root directory of */
/* the project. */
/*----------------------------------------------------------------------------*/
import edu.wpi.first.wpilibj.*;
import edu.wpi.first.wpilibj.vision.*;
public class Robot extends IterativeRobot {
private Joystick controller;
private RobotDrive drive;
private SpeedController one, two, three, four, lift;
//private AxisCamera camera;
//private DigitalInput limit;
public void robotInit() {
joystickInit();
//sensorInit();
speedControllerInit();
robotDriveInit();
}
//public void sensorInit() {
//limit = new DigitalInput(0);
//}
public void joystickInit() {
controller = new Joystick(0);
}
public void speedControllerInit() {
one = new Victor(0);
two = new Victor(1);
three = new Victor(2);
four = new Victor(3);
lift = new Victor(4);
}
public void robotDriveInit() {
drive = new RobotDrive (lift,two, three, four);
}
public void autonomousPeriodic() {
}
public void teleopPeriodic() {
double y = getDeadZone(controller.getY(), 0.1);
double x = getDeadZone(controller.getThrottle(), 0.1);
drive.arcadeDrive(y, x);
if (controller.getRawButton(2)) {
one.set(-1);
} else if (controller.getRawButton(1)){
// && limit.get())
one.set(1);
} else {
one.set(0);
}
}
public void testPeriodic() {
}
public double getDeadZone(double axis, double zone) {
return Math.abs(axis) > zone ? axis : 0;
}
}
package org.usfirst.frc.team3335.robot;
/*----------------------------------------------------------------------------*/
/* Copyright (c) FIRST 2008. All Rights Reserved. */
/* Open Source Software - may be modified and shared by FRC teams. The code */
/* must be accompanied by the FIRST BSD license file in the root directory of */
/* the project. */
/*----------------------------------------------------------------------------*/
import edu.wpi.first.wpilibj.*;
import edu.wpi.first.wpilibj.vision.*;
public class Robot extends IterativeRobot {
private Joystick controller;
private RobotDrive drive;
private SpeedController one, two, three, four, lift;
//private AxisCamera camera;
//private DigitalInput limit;
public void robotInit() {
joystickInit();
//sensorInit();
speedControllerInit();
robotDriveInit();
}
//public void sensorInit() {
//limit = new DigitalInput(0);
//}
public void joystickInit() {
controller = new Joystick(0);
}
public void speedControllerInit() {
one = new Victor(0);
two = new Victor(1);
three = new Victor(2);
four = new Victor(3);
lift = new Victor(4);
}
public void robotDriveInit() {
drive = new RobotDrive (lift,two, three, four);
}
public void autonomousPeriodic() {
}
public void teleopPeriodic() {
double y = getDeadZone(controller.getY(), 0.1);
double x = getDeadZone(controller.getThrottle(), 0.1);
drive.arcadeDrive(y, x);
if (controller.getRawButton(2)) {
one.set(-1);
} else if (controller.getRawButton(1)){
// && limit.get())
one.set(1);
} else {
one.set(0);
}
}
public void testPeriodic() {
}
public double getDeadZone(double axis, double zone) {
return Math.abs(axis) > zone ? axis : 0;
}
}