changed buttons and added half speed
This commit is contained in:
parent
5aa7e83bfa
commit
77bd25c69d
@ -34,18 +34,18 @@ public class OI {
|
|||||||
}
|
}
|
||||||
// Print log when button 1 pressed
|
// Print log when button 1 pressed
|
||||||
//joystickButtons[0][0].whenPressed(new LogEncoder());
|
//joystickButtons[0][0].whenPressed(new LogEncoder());
|
||||||
joystickButtons[0][0].whileHeld(new SpinRollers(1));
|
|
||||||
joystickButtons[0][1].whileHeld(new SetShooterState(true));
|
joystickButtons[0][1].whileHeld(new SetShooterState(true));
|
||||||
|
joystickButtons[0][3].whileHeld(new SpinRollers(1));
|
||||||
// joystickButtons[0][2].whileHeld(new PIDDrive(400));
|
// joystickButtons[0][2].whileHeld(new PIDDrive(400));
|
||||||
joystickButtons[1][0].whileHeld(new MoveArm(0.5));
|
joystickButtons[1][0].whileHeld(new MoveArm(1));
|
||||||
joystickButtons[1][1].whileHeld(new MoveArm(-0.5));
|
joystickButtons[1][1].whileHeld(new MoveArm(-1));
|
||||||
joystickButtons[1][2].whileHeld(new SetArmPosition(RobotMap.mainArmPresetCollect));
|
joystickButtons[1][2].whileHeld(new SetArmPosition(RobotMap.mainArmPresetCollect));
|
||||||
joystickButtons[1][3].whileHeld(new SetArmPosition(RobotMap.mainArmPresetTraverse));
|
joystickButtons[1][3].whileHeld(new SetArmPosition(RobotMap.mainArmPresetTraverse));
|
||||||
joystickButtons[1][4].whileHeld(new SetArmPosition(RobotMap.mainArmPresetCloseShot));
|
joystickButtons[1][4].whileHeld(new SetArmPosition(RobotMap.mainArmPresetCloseShot));
|
||||||
joystickButtons[1][5].whileHeld(new SetArmPosition(RobotMap.mainArmPresetFarShot));
|
joystickButtons[1][5].whileHeld(new SetArmPosition(RobotMap.mainArmPresetFarShot));
|
||||||
joystickButtons[1][7].whileHeld(new SetArmStopState(true));
|
joystickButtons[1][7].whileHeld(new SetArmStopState(true));
|
||||||
joystickButtons[1][10].whileHeld(new ResetLower(-1));
|
// joystickButtons[1][10].whileHeld(new ResetLower(-1));
|
||||||
joystickButtons[1][11].whileHeld(new ResetUpper(1));
|
// joystickButtons[1][11].whileHeld(new ResetUpper(1));
|
||||||
}
|
}
|
||||||
public Joystick[] getJoysticks() {
|
public Joystick[] getJoysticks() {
|
||||||
return joysticks;
|
return joysticks;
|
||||||
|
@ -26,7 +26,7 @@ public class AutoSetArmPosition extends CommandBase {
|
|||||||
// Stop when either limit switch is hit
|
// Stop when either limit switch is hit
|
||||||
System.out.println("AutoSetArmPosition.isFinished(): " + (Math.abs(pos - mainArm.getDegrees()) <= 1));
|
System.out.println("AutoSetArmPosition.isFinished(): " + (Math.abs(pos - mainArm.getDegrees()) <= 1));
|
||||||
System.out.println(" pos : " + pos);
|
System.out.println(" pos : " + pos);
|
||||||
System.out.println(" mainArm.getDegrees() : " + mainArm.getDegrees())
|
System.out.println(" mainArm.getDegrees() : " + mainArm.getDegrees());
|
||||||
return Math.abs(pos - mainArm.getDegrees()) <= 1;
|
return Math.abs(pos - mainArm.getDegrees()) <= 1;
|
||||||
}
|
}
|
||||||
// Called once after isFinished returns true
|
// Called once after isFinished returns true
|
||||||
|
@ -5,6 +5,7 @@ import org.usfirst.frc.team2059.robot.Robot;
|
|||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
public class Drive extends CommandBase {
|
public class Drive extends CommandBase {
|
||||||
|
double sensitivity = 0.5;
|
||||||
public Drive() {
|
public Drive() {
|
||||||
requires(driveBase);
|
requires(driveBase);
|
||||||
}
|
}
|
||||||
@ -16,7 +17,12 @@ public class Drive extends CommandBase {
|
|||||||
double x = Robot.oi.getJoysticks()[0].getRawAxis(0);
|
double x = Robot.oi.getJoysticks()[0].getRawAxis(0);
|
||||||
double y = Robot.oi.getJoysticks()[0].getRawAxis(1);
|
double y = Robot.oi.getJoysticks()[0].getRawAxis(1);
|
||||||
double z = Robot.oi.getJoysticks()[0].getRawAxis(2);
|
double z = Robot.oi.getJoysticks()[0].getRawAxis(2);
|
||||||
driveBase.driveArcade(x, y, z, 0);
|
if(Robot.oi.getJoysticks()[0].getRawButton(1)){
|
||||||
|
sensitivity = 1;
|
||||||
|
}else{
|
||||||
|
sensitivity = 0.5;
|
||||||
|
}
|
||||||
|
driveBase.driveArcade(x, y, z, sensitivity);
|
||||||
}
|
}
|
||||||
// Make this return true when this Command no longer needs to run execute()
|
// Make this return true when this Command no longer needs to run execute()
|
||||||
protected boolean isFinished() {
|
protected boolean isFinished() {
|
||||||
|
@ -23,10 +23,10 @@ public class DriveBase extends Subsystem {
|
|||||||
rightMotorTwo.set(0);
|
rightMotorTwo.set(0);
|
||||||
}
|
}
|
||||||
public void driveArcade(double x, double y, double z, double sensitivity) {
|
public void driveArcade(double x, double y, double z, double sensitivity) {
|
||||||
leftMotorOne.set(-y + (x + z));
|
leftMotorOne.set((-y + (x + z))*sensitivity);
|
||||||
leftMotorTwo.set(-y + (x + z));
|
leftMotorTwo.set((-y + (x + z))*sensitivity);
|
||||||
rightMotorOne.set(y + (x + z));
|
rightMotorOne.set((y + (x + z))*sensitivity);
|
||||||
rightMotorTwo.set(y + (x + z));
|
rightMotorTwo.set((y + (x + z))*sensitivity);
|
||||||
}
|
}
|
||||||
public void pidDrive(double setpoint) {
|
public void pidDrive(double setpoint) {
|
||||||
leftEncoder.reset();
|
leftEncoder.reset();
|
||||||
|
Loading…
x
Reference in New Issue
Block a user