import edu.wpi.first.math.util.Units;
import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
import edu.wpi.first.wpilibj2.command.Command;
+import edu.wpi.first.wpilibj2.command.InstantCommand;
import frc.robot.constants.Constants;
import frc.robot.constants.FieldConstants;
import frc.robot.constants.ShotInterpolation;
turretOffset = SmartDashboard.getNumber("OPERATOR: Turret Offset", turretOffset);
SmartDashboard.putNumber("OPERATOR: Turret Offset", turretOffset);
-
+ SmartDashboard.putData("Hood: Shoot Higher", new InstantCommand(() -> bumpUpHoodOffset()));
+ SmartDashboard.putData("Hood: Shoot Lower", new InstantCommand(() -> bumpDownHoodOffset()));
+ SmartDashboard.putData("Turret: Aim Left", new InstantCommand(() -> bumpUpTurretOffset()));
+ SmartDashboard.putData("Turret: Aim Right", new InstantCommand(() -> bumpDownTurretOffset()));
+
// Phase manager stuff
phaseManager.update(drivepose, shooter, turret);
target = phaseManager.getTarget(drivepose);
shooterVelocityMap.put(11.4, 28.1); // was 25.2 before
shooterVelocityMap.put(16.54, 33.8); // untested
-
-
// always shoot at low angle to ground.
newHoodMap.put(0.0, 60.0);
newHoodMap.put(27.99, 60.0);
-
}
}