|
1 | 1 | package pioneer.opmodes.teleop |
2 | 2 |
|
| 3 | +import com.acmerobotics.dashboard.FtcDashboard |
3 | 4 | import com.qualcomm.robotcore.eventloop.opmode.TeleOp |
4 | 5 | import org.firstinspires.ftc.robotcore.external.navigation.CurrentUnit |
5 | 6 | import pioneer.Bot |
@@ -64,11 +65,17 @@ class Teleop : BaseOpMode() { |
64 | 65 | telemetry.addData("Flywheel Speed", driver2.flywheelVelocityEnum) |
65 | 66 | telemetry.addData("Flywheel TPS", bot.flywheel?.velocity) |
66 | 67 | telemetry.addData("Turret Angle", driver2.turretAngle) |
| 68 | + telemetry.addData("Turret Target Ticks", bot.turret?.targetTicks) |
| 69 | + telemetry.addData("Turret Real Ticks", bot.turret?.currentTicks) |
67 | 70 | telemetry.addData("Drive Power", driver1.drivePower) |
68 | 71 | telemetry.addData("Field Centric", driver1.fieldCentric) |
69 | 72 | telemetry.addData("Velocity", "vx: %.2f, vy: %.2f".format(bot.pinpoint?.pose?.vx, bot.pinpoint?.pose?.vy)) |
70 | 73 | telemetry.addData("Voltage", bot.batteryMonitor?.voltage) |
71 | 74 | telemetry.addData("Flywheel Motor Current", bot.flywheel?.motor?.getCurrent(CurrentUnit.MILLIAMPS)) |
72 | 75 | telemetryPacket.addLine("Flywheel TPS" + (bot.flywheel?.velocity ?: 0.0)) |
| 76 | + |
| 77 | + telemetryPacket.put("Turret Target Ticks", bot.turret?.targetTicks) |
| 78 | + telemetryPacket.put("Turret Current Ticks", bot.turret?.currentTicks) |
| 79 | + |
73 | 80 | } |
74 | 81 | } |
0 commit comments