diff --git a/src/main/java/competition/simulation/MapleSimulator.java b/src/main/java/competition/simulation/MapleSimulator.java index 643bd97e..a3f84c62 100644 --- a/src/main/java/competition/simulation/MapleSimulator.java +++ b/src/main/java/competition/simulation/MapleSimulator.java @@ -147,6 +147,7 @@ protected void updateDriveSimulation() { @Override public void resetPosition(Pose2d pose) { arena.resetFieldForAuto(); + this.intakeSimulator.reset(); this.swerveDriveSimulation.getDriveTrainSimulation().setSimulationWorldPose(pose); this.pose.setCurrentPoseInMeters(pose); } diff --git a/src/main/java/competition/simulation/intake/CollectorSimulator.java b/src/main/java/competition/simulation/intake/CollectorSimulator.java index df355243..5c01a577 100644 --- a/src/main/java/competition/simulation/intake/CollectorSimulator.java +++ b/src/main/java/competition/simulation/intake/CollectorSimulator.java @@ -19,7 +19,7 @@ public class CollectorSimulator { final MockCANMotorController collectorMotor; - private int heldPieces = 0; + private int heldPieces = 8; final AKitLogger aKitLog = new AKitLogger("Simulator/Collector/"); @Inject @@ -54,6 +54,10 @@ public boolean getPieceFromCollector() { return false; } + public void reset() { + heldPieces = 8; + } + public void update() { aKitLog.record("IntakeDeployDeployed", intakeDeploySim.isDeployed()); aKitLog.record("CollectorMotorPower", collectorMotor.getPower());