|
// TODO: reverse encoder directions |
private Pose2d txPinpointRobot = new Pose2d(0, 0, 0);
public PinpointLocalizer(HardwareMap hardwareMap, Pose2d initialPose) {
// TODO: make sure your config has a Pinpoint device with this
// see https://ftc-docs.firstinspires.org/en/latest/hardware_and_software_configuration/configuring/index.html
driver = hardwareMap.get(GoBildaPinpointDriver.class, "odo");
driver.setEncoderResolution(PARAMS.res, DistanceUnit.MM);
driver.setOffsets(PARAMS.xOffset, PARAMS.yOffset, DistanceUnit.MM);
// TODO: reverse encoder directions
initialParDirection = GoBildaPinpointDriver.EncoderDirection.FORWARD;
initialPerpDirection = GoBildaPinpointDriver.EncoderDirection.FORWARD;
Decode/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/roadrunner/PinpointLocalizer.java
Line 46 in e4a27c5