Dashboard telemetry

ftc13100 · Nov 14, 2024 · 190d5c4 · 190d5c4
1 parent 215e9b5
commit 190d5c4
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/TeamCode/src/main/kotlin/org/firstinspires/ftc/teamcode/opModes/tuning/arm/ArmPIDTuner.kt b/TeamCode/src/main/kotlin/org/firstinspires/ftc/teamcode/opModes/tuning/arm/ArmPIDTuner.kt
@@ -5,6 +5,7 @@ import com.acmerobotics.dashboard.config.Config
 import com.acmerobotics.dashboard.telemetry.MultipleTelemetry
 import com.arcrobotics.ftclib.command.CommandOpMode
 import com.arcrobotics.ftclib.command.InstantCommand
+import com.arcrobotics.ftclib.command.RunCommand
 import com.arcrobotics.ftclib.hardware.motors.Motor
 import com.qualcomm.robotcore.eventloop.opmode.TeleOp
 import org.firstinspires.ftc.teamcode.constants.ControlBoard
@@ -29,6 +30,11 @@ class ArmPIDTuner : CommandOpMode() {
         InstantCommand({
             armSubsystem.setpoint = Math.toRadians(target)
         }).perpetually().schedule()
+
+        RunCommand({
+            telemetry.addData("Arm Angle: ", armSubsystem.armAngle)
+            telemetry.addData("Setpoint: ", target)
+        })
     }
 
     companion object {