diff --git a/src/main/deploy/pathplanner/autos/BlueLClose3.auto b/src/main/deploy/pathplanner/autos/BlueLClose3.auto index 9639475..237007d 100644 --- a/src/main/deploy/pathplanner/autos/BlueLClose3.auto +++ b/src/main/deploy/pathplanner/autos/BlueLClose3.auto @@ -20,13 +20,7 @@ { "type": "named", "data": { - "name": "FloorPickup" - } - }, - { - "type": "named", - "data": { - "name": "RunIntake" + "name": "ShootNoteClose" } }, { @@ -41,12 +35,6 @@ "name": "FloorPickup" } }, - { - "type": "named", - "data": { - "name": "RunIntake" - } - }, { "type": "path", "data": { @@ -56,13 +44,7 @@ { "type": "named", "data": { - "name": "FloorPickup" - } - }, - { - "type": "named", - "data": { - "name": "RunIntake" + "name": "ShootNoteClose" } } ] diff --git a/src/main/java/frc/robot/commands/ControlCommands/DriveCommands.java b/src/main/java/frc/robot/commands/ControlCommands/DriveCommands.java index 3d050cb..dc12ce5 100644 --- a/src/main/java/frc/robot/commands/ControlCommands/DriveCommands.java +++ b/src/main/java/frc/robot/commands/ControlCommands/DriveCommands.java @@ -116,7 +116,10 @@ public static Command runOverClosestNote(Drive sDrive, Intake sIntake, Flywheel if (newDistance < distance || distance == 0) { distance = currentPostition.getDistance(checkingNotePostition); - closestNotePosition = new Translation2d(x, y); + closestNotePosition = + new Translation2d( + currentPostition.getX() + (x - currentPostition.getX()) / 2, + currentPostition.getY() + (y - currentPostition.getY()) / 2); } }