made driveTrain.java but no sensors
This commit is contained in:
@@ -20,6 +20,25 @@ public class Drivetrain extends SubsystemBase{
|
||||
|
||||
private Drivetrain() {
|
||||
leftFront = new CANSparkMax(DrivetrainConstants.kLeftFrontID, MotorType.kBrushless);
|
||||
rightFront = new CANSparkMax(DrivetrainConstants.kRightFrontID, MotorType.kBrushless);
|
||||
leftRear = new CANSparkMax(DrivetrainConstants.kLeftRearID, MotorType.kBrushless);
|
||||
rightRear = new CANSparkMax(DrivetrainConstants.kRightRearID, MotorType.kBrushless);
|
||||
|
||||
((CANSparkMax)leftRear).follow((CANSparkMax)leftFront);
|
||||
((CANSparkMax)rightRear).follow((CANSparkMax)rightFront);
|
||||
|
||||
rightFront.setInverted(true);
|
||||
|
||||
drive = new DifferentialDrive(leftFront, rightFront);
|
||||
}
|
||||
public Command driveArcade(DoubleSupplier xSpeed, DoubleSupplier zRotation) {
|
||||
return run (() -> {
|
||||
drive.arcadeDrive(xSpeed.getAsDouble(), zRotation.getAsDouble());
|
||||
});
|
||||
}
|
||||
public Command driveTank(DoubleSupplier leftSpeed, DoubleSupplier rightSpeed) {
|
||||
return run(() -> {
|
||||
drive.tankDrive(leftSpeed.getAsDouble(), rightSpeed.getAsDouble());
|
||||
});
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user