diff --git a/src/main/deploy/pathplanner/autos/Center to Shoot.auto b/src/main/deploy/pathplanner/autos/Center Back up.auto similarity index 100% rename from src/main/deploy/pathplanner/autos/Center to Shoot.auto rename to src/main/deploy/pathplanner/autos/Center Back up.auto diff --git a/src/main/deploy/pathplanner/autos/Left Shoot.auto b/src/main/deploy/pathplanner/autos/Left Shoot Outpost.auto similarity index 100% rename from src/main/deploy/pathplanner/autos/Left Shoot.auto rename to src/main/deploy/pathplanner/autos/Left Shoot Outpost.auto diff --git a/src/main/deploy/pathplanner/paths/over bump to pile move.path b/src/main/deploy/pathplanner/paths/over bump to pile move.path index 972f3f3..403f537 100644 --- a/src/main/deploy/pathplanner/paths/over bump to pile move.path +++ b/src/main/deploy/pathplanner/paths/over bump to pile move.path @@ -16,16 +16,16 @@ }, { "anchor": { - "x": 7.616223350253808, - "y": 7.207197969543147 + "x": 7.2386903553299495, + "y": 7.326903553299493 }, "prevControl": { - "x": 6.616223350253808, - "y": 7.207197969543147 + "x": 6.2386903553299495, + "y": 7.326903553299493 }, "nextControl": { - "x": 8.616223350253813, - "y": 7.207197969543147 + "x": 8.238690355329947, + "y": 7.326903553299493 }, "isLocked": false, "linkedName": null diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java index c716e17..854af9b 100644 --- a/src/main/java/frc/robot/RobotContainer.java +++ b/src/main/java/frc/robot/RobotContainer.java @@ -14,6 +14,7 @@ import org.littletonrobotics.junction.Logger; import com.pathplanner.lib.auto.AutoBuilder; import com.pathplanner.lib.auto.NamedCommands; +import com.pathplanner.lib.commands.PathPlannerAuto; import com.pathplanner.lib.events.EventTrigger; import com.pathplanner.lib.path.EventMarker; @@ -113,6 +114,16 @@ public class RobotContainer { if(AutoConstants.kAutoConfigOk) { autoChooser = AutoBuilder.buildAutoChooser(); SmartDashboard.putData("Auto Chooser", autoChooser); + + autoChooser.addOption( + "MOVE B____ right to center", + new PathPlannerAuto("MOVE B____ left to center", true) + ); + + autoChooser.addOption( + "right to center", + new PathPlannerAuto("left to center", true) + ); } } diff --git a/src/main/java/frc/robot/constants/DrivetrainConstants.java b/src/main/java/frc/robot/constants/DrivetrainConstants.java index 6b0d6d4..c46e576 100644 --- a/src/main/java/frc/robot/constants/DrivetrainConstants.java +++ b/src/main/java/frc/robot/constants/DrivetrainConstants.java @@ -46,7 +46,7 @@ public class DrivetrainConstants { // TODO How much do we trust gyro and encoders vs vision estimates. // NOTE: Bigger values indicate LESS trust. Generally all three values for a given matrix should be the same public static final Matrix kSensorFusionOdometryStdDevs = VecBuilder.fill(0.1, 0.1, 0.1); - public static final Matrix kVisionOdometryStdDevs = VecBuilder.fill(0.9, 0.9, 0.9); + public static final Matrix kVisionOdometryStdDevs = VecBuilder.fill(0.3, 0.3, 0.3); // YOU SHOULDN'T NEED TO CHANGE ANYTHING BELOW THIS LINE UNLESS YOU'RE ADDING A NEW CONFIGURATION ITEM public static final SwerveDriveKinematics kDriveKinematics = new SwerveDriveKinematics(