diff --git a/TeamCode/src/main/java/ftclib b/TeamCode/src/main/java/ftclib index 08bc278..4ce2631 160000 --- a/TeamCode/src/main/java/ftclib +++ b/TeamCode/src/main/java/ftclib @@ -1 +1 @@ -Subproject commit 08bc2787ee2ee93c2f866b94d45327c4a4c650ea +Subproject commit 4ce26319c94beac022ffde84959d0b36bf7b3c5b diff --git a/TeamCode/src/main/java/teamcode/RobotParams.java b/TeamCode/src/main/java/teamcode/RobotParams.java index c5c51fd..75db3fe 100644 --- a/TeamCode/src/main/java/teamcode/RobotParams.java +++ b/TeamCode/src/main/java/teamcode/RobotParams.java @@ -299,9 +299,11 @@ public class RobotParams odometryType = TrcDriveBase.OdometryType.MotorOdometry; // Odometry Wheels odWheelXScale = odWheelYScale = Math.PI * ODWHEEL_DIAMETER / ODWHEEL_CPR; + xOdWheelSensorNames = null; xOdWheelIndices = new int[] {FtcRobotDrive.INDEX_RIGHT_BACK}; xOdWheelXOffsets = new double[] {0.0}; xOdWheelYOffsets = new double[] {-168.0 * TrcUtil.INCHES_PER_MM}; + yOdWheelSensorNames = null; yOdWheelIndices = new int[] {FtcRobotDrive.INDEX_LEFT_FRONT, FtcRobotDrive.INDEX_RIGHT_FRONT}; yOdWheelXOffsets = new double[] {-144.0 * TrcUtil.INCHES_PER_MM, -12.0 * TrcUtil.INCHES_PER_MM}; yOdWheelYOffsets = new double[] {144.0 * TrcUtil.INCHES_PER_MM, -12.0 * TrcUtil.INCHES_PER_MM}; @@ -367,10 +369,12 @@ public class RobotParams odometryType = TrcDriveBase.OdometryType.AbsoluteOdometry; // Odometry Wheels odWheelXScale = odWheelYScale = Math.PI * ODWHEEL_DIAMETER / ODWHEEL_CPR; - xOdWheelIndices = new int[] {FtcRobotDrive.INDEX_RIGHT_BACK}; + xOdWheelSensorNames = new String[] {"xOdWheelSensor"}; + xOdWheelIndices = new int[] {0}; xOdWheelXOffsets = new double[] {0.0}; xOdWheelYOffsets = new double[] {-168.0 * TrcUtil.INCHES_PER_MM}; - yOdWheelIndices = new int[] {FtcRobotDrive.INDEX_LEFT_FRONT, FtcRobotDrive.INDEX_RIGHT_FRONT}; + yOdWheelSensorNames = new String[] {"yLeftOdWheelSensor", "yRightOdWheelSensor"}; + yOdWheelIndices = new int[] {1, 2}; yOdWheelXOffsets = new double[] {-144.0 * TrcUtil.INCHES_PER_MM, -12.0 * TrcUtil.INCHES_PER_MM}; yOdWheelYOffsets = new double[] {144.0 * TrcUtil.INCHES_PER_MM, -12.0 * TrcUtil.INCHES_PER_MM}; // Absolute Odometry @@ -449,9 +453,11 @@ public class RobotParams odometryType = TrcDriveBase.OdometryType.OdometryWheels; // Odometry Wheels odWheelXScale = odWheelYScale = Math.PI * ODWHEEL_DIAMETER / ODWHEEL_CPR; + xOdWheelSensorNames = null; xOdWheelIndices = new int[] {FtcRobotDrive.INDEX_RIGHT_BACK}; xOdWheelXOffsets = new double[] {0.0}; xOdWheelYOffsets = new double[] {-168.0 * TrcUtil.INCHES_PER_MM}; + yOdWheelSensorNames = null; yOdWheelIndices = new int[] {FtcRobotDrive.INDEX_LEFT_FRONT, FtcRobotDrive.INDEX_RIGHT_FRONT}; yOdWheelXOffsets = new double[] {-144.0 * TrcUtil.INCHES_PER_MM, -12.0 * TrcUtil.INCHES_PER_MM}; yOdWheelYOffsets = new double[] {144.0 * TrcUtil.INCHES_PER_MM, -12.0 * TrcUtil.INCHES_PER_MM};