mirror of
https://github.com/Team4388/2023WayOfTheRobot.git
synced 2026-06-09 00:37:59 -06:00
riolog print cleanup
This commit is contained in:
@@ -128,7 +128,6 @@ public class RobotContainer {
|
||||
// TODO: find actual values
|
||||
private SequentialCommandGroup placeCubeHigh =
|
||||
new SequentialCommandGroup(
|
||||
// new InstantCommand(() -> System.out.println("Placing cone high")),
|
||||
new PivotCommand(m_robotArm, 64 + 135),
|
||||
new InstantCommand(() -> m_robotArm.setRotVel(0)),
|
||||
new TeleCommand(m_robotArm, 95642),
|
||||
|
||||
@@ -38,7 +38,6 @@ public class DriveToLimeDistance extends PelvicInflammatoryDisease {
|
||||
|
||||
@Override
|
||||
public void runWithOutput(double output) {
|
||||
System.out.println(output / Math.abs(getError()));
|
||||
drive.driveWithInput(new Translation2d(0.0, output / Math.abs(getError())), new Translation2d(0.0, 0.0), true);
|
||||
}
|
||||
}
|
||||
|
||||
@@ -34,7 +34,6 @@ public class LimeAlign extends PelvicInflammatoryDisease {
|
||||
double err = 0.0;
|
||||
|
||||
try {
|
||||
System.out.println(ds.getAsDouble());
|
||||
err = ds.getAsDouble() / (VisionConstants.H_FOV / 2);
|
||||
} catch (NullPointerException ex) {}
|
||||
|
||||
|
||||
@@ -60,7 +60,6 @@ public class JoystickPlayback extends CommandBase {
|
||||
}
|
||||
|
||||
String[] values = line.split(",");
|
||||
System.out.println("values: " + values[0] + " " + values[1] + " " + values[2] + " " + values[3]);
|
||||
|
||||
var out = new TimedOutput();
|
||||
out.leftX = Double.parseDouble(values[0]) * mult;
|
||||
|
||||
@@ -68,7 +68,6 @@ public class JoystickRecorder extends CommandBase {
|
||||
new Translation2d(inputs.rightX, inputs.rightY),
|
||||
true);
|
||||
|
||||
System.out.println("RECORDING");
|
||||
}
|
||||
|
||||
// Called once the command ends or is interrupted.
|
||||
|
||||
@@ -143,29 +143,14 @@ public class SwerveDrive extends SubsystemBase {
|
||||
|
||||
public void setToSlow() {
|
||||
this.speedAdjust = SwerveDriveConstants.SLOW_SPEED;
|
||||
System.out.println("SLOW");
|
||||
System.out.println("SLOW");
|
||||
System.out.println("SLOW");
|
||||
System.out.println("SLOW");
|
||||
System.out.println("SLOW");
|
||||
}
|
||||
|
||||
public void setToFast() {
|
||||
this.speedAdjust = SwerveDriveConstants.FAST_SPEED;
|
||||
System.out.println("FAST");
|
||||
System.out.println("FAST");
|
||||
System.out.println("FAST");
|
||||
System.out.println("FAST");
|
||||
System.out.println("FAST");
|
||||
}
|
||||
|
||||
public void setToTurbo() {
|
||||
this.speedAdjust = SwerveDriveConstants.TURBO_SPEED;
|
||||
System.out.println("TURBO");
|
||||
System.out.println("TURBO");
|
||||
System.out.println("TURBO");
|
||||
System.out.println("TURBO");
|
||||
System.out.println("TURBO");
|
||||
}
|
||||
|
||||
public void shiftUp() {
|
||||
|
||||
Reference in New Issue
Block a user