Skip to content
Open
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
Original file line number Diff line number Diff line change
Expand Up @@ -32,9 +32,9 @@ public void execute() {
claw.setClawMotor(clawSpeed * 0.5);
// claw.setPivotMotor(pivotSpeed * 0.05);

// SmartDashboard.putNumber("Algae Pivot Encoder Ticks", claw.getPivotEncoderTicks());
// SmartDashboard.putNumber("Algae Pivot/Encoder Ticks", claw.getPivotEncoderTicks());

SmartDashboard.putNumber("Algae Claw Current", claw.getClawMotor().getOutputCurrent()); // TODO use this to identify the current max for deadbanding
SmartDashboard.putNumber("Algae Claw/Current", claw.getClawMotor().getOutputCurrent()); // TODO use this to identify the current max for deadbanding
}

@Override
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -37,9 +37,9 @@ public void initialize() {
@Override
public void execute() {

SmartDashboard.putNumber("Algae Encoder Ticks", claw.getPivotEncoderTicks());
SmartDashboard.putNumber("Algae Pivot", claw.getPivotMotor().get());
SmartDashboard.putNumber("Algae Pivot Applied", claw.getPivotMotor().getAppliedOutput());
SmartDashboard.putNumber("Algae Pivot/Encoder Ticks", claw.getPivotEncoderTicks());
SmartDashboard.putNumber("Algae Pivot/Motor", claw.getPivotMotor().get());
SmartDashboard.putNumber("Algae Pivot/Applied", claw.getPivotMotor().getAppliedOutput());

}

Expand Down
14 changes: 7 additions & 7 deletions src/main/java/frc/robot/subsystems/camera/AprilTagCamera.java
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@ public AprilTagCamera(String cameraName, Transform3d robotToCamera, CommandSwerv
this.drivetrain = drivetrain;

cameraEnabled = new SendableChooser<Boolean>();
cameraEnabled.setDefaultOption("Enabled", true);
cameraEnabled.setDefaultOption(cameraName + "/Enabled", true);
cameraEnabled.addOption("Disabled", false);
SmartDashboard.putData(String.format("%s Enabled?", cameraName), cameraEnabled);

Expand All @@ -61,13 +61,13 @@ public void periodic() {
boolean hasPose = false;

if (result.hasTargets()) {
SmartDashboard.putNumber("Target Count", result.targets.size());
SmartDashboard.putNumber(cameraName + "/Target Count", result.targets.size());

for (PhotonTrackedTarget target : result.targets) {
SmartDashboard.putNumber("Target ID", target.getFiducialId());
SmartDashboard.putNumber("Yaw", target.getYaw());
SmartDashboard.putNumber("Pitch", target.getPitch());
SmartDashboard.putNumber("Area", target.getArea());
SmartDashboard.putNumber(cameraName + "/Target ID", target.getFiducialId());
SmartDashboard.putNumber(cameraName + "/Yaw", target.getYaw());
SmartDashboard.putNumber(cameraName + "/Pitch", target.getPitch());
SmartDashboard.putNumber(cameraName + "/Area", target.getArea());

for (int tag : Constants.AutoDriveConstants.GOOD_APRIL_TAGS) {
if (target.getFiducialId() == tag) {
Expand All @@ -90,7 +90,7 @@ public void periodic() {
if (this.cameraEnabled.getSelected()) {
drivetrain.addVisionMeasurement(visionPose.toPose2d(), Utils.getCurrentTimeSeconds());
}
SmartDashboard.putString("Vision Pose", visionPose.toString());
SmartDashboard.putString(cameraName + "/Vision Pose", visionPose.toString());
}
}
} else {
Expand Down
8 changes: 4 additions & 4 deletions src/main/java/frc/robot/subsystems/elevator/Elevator.java
Original file line number Diff line number Diff line change
Expand Up @@ -141,10 +141,10 @@ public void periodic() {
ArbFFUnits.kVoltage
);

SmartDashboard.putNumber("Current State Ticks", currentState.position);
SmartDashboard.putNumber("Current State Velocity", currentState.velocity);
SmartDashboard.putNumber("Goal State Ticks", goalState.position);
SmartDashboard.putNumber("Current Ticks", this.getAvgEncoderTicks());
SmartDashboard.putNumber("Elevator/Current State Ticks", currentState.position);
SmartDashboard.putNumber("Elevator/Current State Velocity", currentState.velocity);
SmartDashboard.putNumber("Elevator/Goal State Ticks", goalState.position);
SmartDashboard.putNumber("Elevator/Current Ticks", this.getAvgEncoderTicks());
}

public Command sysIdDynamic(Direction direction) {
Expand Down
8 changes: 4 additions & 4 deletions src/main/java/frc/robot/subsystems/scoring/AlgaeClaw.java
Original file line number Diff line number Diff line change
Expand Up @@ -62,10 +62,10 @@ public boolean holdingAlgae() {

@Override
public void periodic() {
SmartDashboard.putNumber("Claw Motor Speed", clawMotor.get());
SmartDashboard.putNumber("Color Sensor Proximity", this.colorSensor.getProximity());
SmartDashboard.putNumber("Color Sensor Blue", this.colorSensor.getBlue());
SmartDashboard.putNumber("Color Sensor Test", this.colorSensor.getRed());
SmartDashboard.putNumber("Algae Claw/Claw Motor Speed", clawMotor.get());
SmartDashboard.putNumber("Algae Claw/Color Sensor Proximity", this.colorSensor.getProximity());
SmartDashboard.putNumber("Algae Claw/Color Sensor Blue", this.colorSensor.getBlue());
SmartDashboard.putNumber("Algae Claw/Color Sensor Test", this.colorSensor.getRed());

if (this.timer.hasElapsed(PULSE_FREQUENCY) && this.getClawMotor().get() == 0.0 && this.holdingAlgae()) {
CommandScheduler.getInstance().schedule(new InstantCommand(() -> {
Expand Down
4 changes: 2 additions & 2 deletions src/main/java/frc/robot/subsystems/scoring/AlgaePivot.java
Original file line number Diff line number Diff line change
Expand Up @@ -87,7 +87,7 @@ public void periodic() {
ClosedLoopSlot.kSlot0
);

SmartDashboard.putNumber("Pivot Setpoint", setpointTicks);
SmartDashboard.putNumber("Pivot Current Position", currentState.position);
SmartDashboard.putNumber("Algae Pivot/Setpoint", setpointTicks);
SmartDashboard.putNumber("Algae Pivot/Current Position", currentState.position);
}
}
Original file line number Diff line number Diff line change
Expand Up @@ -82,7 +82,7 @@ public double getAvgEncoderTicks() {

@Override
public void periodic() {
SmartDashboard.putBoolean("BEAM EXISTS CORAL SHOOTER", this.beamExists());
SmartDashboard.putBoolean("CORAL SHOOTER/BEAM EXISTS", this.beamExists());
}

}