robotDrive = new RobotDrive(frontLeft, rearLeft, frontRight, rearRight);
- lidar = new Lidar(I2C.Port.kOnboard);
-
+ lidar = new Lidar(I2C.Port.kMXP);
leftEncoder = new Encoder(Constants.DriveTrain.ENCODER_LEFT_A,
Constants.DriveTrain.ENCODER_LEFT_B, false, EncodingType.k4X);
rightEncoder = new Encoder(Constants.DriveTrain.ENCODER_RIGHT_A,
this.disable();
gyro.start();
- leftGearPiston = new DoubleSolenoid(Constants.DriveTrain.LEFT_FORWARD,
+ leftGearPiston = new DoubleSolenoid(10, Constants.DriveTrain.LEFT_FORWARD,
Constants.DriveTrain.LEFT_REVERSE);
- rightGearPiston = new DoubleSolenoid(Constants.DriveTrain.RIGHT_FORWARD,
+ rightGearPiston = new DoubleSolenoid(10,
+ Constants.DriveTrain.RIGHT_FORWARD,
Constants.DriveTrain.RIGHT_REVERSE);
Constants.DriveTrain.inverted = false;
}
output = Math.signum(output) * 0.3;
left = output;
right = output + drift * Constants.DriveTrain.kp / 10;
+ drive(left, right);
} else if (DRIVE_MODE == Constants.DriveTrain.GYRO_MODE) {
left = output;
right = -output;
+ arcadeDrive(0, output);
}
- drive(left, right);
pidOutput = output;
}
robotDrive.tankDrive(right, left);
}
+ public void arcadeDrive(double y, double twist) {
+ robotDrive.arcadeDrive(y, twist);
+ }
+
/*
* constrains the distance to within -100 and 100 since we aren't going to
* drive more than 100 inches