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
|
// TODO: find actual values
|
||||||
private SequentialCommandGroup placeCubeHigh =
|
private SequentialCommandGroup placeCubeHigh =
|
||||||
new SequentialCommandGroup(
|
new SequentialCommandGroup(
|
||||||
// new InstantCommand(() -> System.out.println("Placing cone high")),
|
|
||||||
new PivotCommand(m_robotArm, 64 + 135),
|
new PivotCommand(m_robotArm, 64 + 135),
|
||||||
new InstantCommand(() -> m_robotArm.setRotVel(0)),
|
new InstantCommand(() -> m_robotArm.setRotVel(0)),
|
||||||
new TeleCommand(m_robotArm, 95642),
|
new TeleCommand(m_robotArm, 95642),
|
||||||
|
|||||||
@@ -38,7 +38,6 @@ public class DriveToLimeDistance extends PelvicInflammatoryDisease {
|
|||||||
|
|
||||||
@Override
|
@Override
|
||||||
public void runWithOutput(double output) {
|
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);
|
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;
|
double err = 0.0;
|
||||||
|
|
||||||
try {
|
try {
|
||||||
System.out.println(ds.getAsDouble());
|
|
||||||
err = ds.getAsDouble() / (VisionConstants.H_FOV / 2);
|
err = ds.getAsDouble() / (VisionConstants.H_FOV / 2);
|
||||||
} catch (NullPointerException ex) {}
|
} catch (NullPointerException ex) {}
|
||||||
|
|
||||||
|
|||||||
@@ -60,7 +60,6 @@ public class JoystickPlayback extends CommandBase {
|
|||||||
}
|
}
|
||||||
|
|
||||||
String[] values = line.split(",");
|
String[] values = line.split(",");
|
||||||
System.out.println("values: " + values[0] + " " + values[1] + " " + values[2] + " " + values[3]);
|
|
||||||
|
|
||||||
var out = new TimedOutput();
|
var out = new TimedOutput();
|
||||||
out.leftX = Double.parseDouble(values[0]) * mult;
|
out.leftX = Double.parseDouble(values[0]) * mult;
|
||||||
|
|||||||
@@ -68,7 +68,6 @@ public class JoystickRecorder extends CommandBase {
|
|||||||
new Translation2d(inputs.rightX, inputs.rightY),
|
new Translation2d(inputs.rightX, inputs.rightY),
|
||||||
true);
|
true);
|
||||||
|
|
||||||
System.out.println("RECORDING");
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// Called once the command ends or is interrupted.
|
// Called once the command ends or is interrupted.
|
||||||
|
|||||||
@@ -143,29 +143,14 @@ public class SwerveDrive extends SubsystemBase {
|
|||||||
|
|
||||||
public void setToSlow() {
|
public void setToSlow() {
|
||||||
this.speedAdjust = SwerveDriveConstants.SLOW_SPEED;
|
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() {
|
public void setToFast() {
|
||||||
this.speedAdjust = SwerveDriveConstants.FAST_SPEED;
|
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() {
|
public void setToTurbo() {
|
||||||
this.speedAdjust = SwerveDriveConstants.TURBO_SPEED;
|
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() {
|
public void shiftUp() {
|
||||||
|
|||||||
Reference in New Issue
Block a user