diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java index 7280f9e4b18b..4dd471c4a7fc 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/PinpointDrive.java @@ -2,16 +2,11 @@ -import static com.acmerobotics.roadrunner.ftc.OTOSKt.OTOSPoseToRRPose; -import static com.acmerobotics.roadrunner.ftc.OTOSKt.RRPoseToOTOSPose; - import com.acmerobotics.roadrunner.Pose2d; import com.acmerobotics.roadrunner.PoseVelocity2d; -import com.acmerobotics.roadrunner.Vector2d; import com.acmerobotics.roadrunner.ftc.FlightRecorder; import com.acmerobotics.roadrunner.ftc.GoBildaPinpointDriver; import com.acmerobotics.roadrunner.ftc.GoBildaPinpointDriverRR; -import com.qualcomm.hardware.sparkfun.SparkFunOTOS; import com.qualcomm.robotcore.hardware.HardwareMap; import org.firstinspires.ftc.robotcore.external.navigation.DistanceUnit; import org.firstinspires.ftc.teamcode.messages.PoseMessage; @@ -65,6 +60,7 @@ increase when you move the robot forward. And the Y (strafe) pod should increase public PinpointDrive(HardwareMap hardwareMap, Pose2d pose) { super(hardwareMap, pose); + FlightRecorder.write("PINPOINT_PARAMS",PARAMS); pinpoint = hardwareMap.get(GoBildaPinpointDriverRR.class,"pinpoint"); // RR localizer note: don't love this conversion (change driver?)