import edu.wpi.first.wpilibj.CANTalon;
import edu.wpi.first.wpilibj.CounterBase.EncodingType;
import edu.wpi.first.wpilibj.DoubleSolenoid;
+import edu.wpi.first.wpilibj.DoubleSolenoid.Value;
import edu.wpi.first.wpilibj.Encoder;
import edu.wpi.first.wpilibj.I2C;
import edu.wpi.first.wpilibj.RobotDrive;
// Drivetrain specific constants that relate to the PID controllers
private final static double Kp = 1.0, Ki = 0.0,
Kd = 0.0 * (OUTPUT_SPROCKET_DIAMETER / PULSES_PER_ROTATION)
- / (WHEEL_SPROCKET_DIAMETER) * WHEEL_DIAMETER;
+ / (WHEEL_SPROCKET_DIAMETER) * WHEEL_DIAMETER;
public DriveTrain() {
super(kp, ki, kd);
rightEncoder.reset();
}
+ public Value getLeftGearPistonValue() {
+ return leftGearPiston.get();
+ }
+
+ public Value getRightGearPistonValue() {
+ return rightGearPiston.get();
+ }
+
public double getRightSpeed() {
return rightEncoder.getRate(); // in inches per second
}