TOFAdjustment = SmartDashboard.getNumber("OPERATOR: TOF Adjustment", TOFAdjustment);
SmartDashboard.putNumber("OPERATOR: TOF Adjustment", TOFAdjustment);
hoodOffset = SmartDashboard.getNumber("OPERATOR: Hood Offset", hoodOffset);
- SmartDashboard.putNumber("OPERATOR: Hood Offset", hoodOffset);
+ SmartDashboard.putNumber("OPERATOR: Hood Offset", hoodOffset);
turretOffset = SmartDashboard.getNumber("OPERATOR: Turret Offset", turretOffset);
SmartDashboard.putNumber("OPERATOR: Turret Offset", turretOffset);
}// else {
// hoodOffset = 0.0;
// turretOffset = 0.0;
// }
+
// Phase manager stuff
phaseManager.update(drivepose, shooter, turret);
shooterVelocityMap.put(0.0, 9.0);
shooterVelocityMap.put(4.0, 12.8);
shooterVelocityMap.put(7.6, 19.0);
- shooterVelocityMap.put(11.4, 28.1);
+ shooterVelocityMap.put(11.4, 28.1); // was 25.2 before
SmartDashboard.putBoolean("Turret Calibrated", !calibrating);
SmartDashboard.putBoolean("Turret At Setpoint", atSetpoint());
}
+
}
/* ---------------- Simulation ---------------- */
import edu.wpi.first.math.util.Units;
public class TurretConstants {
- public static double MAX_ANGLE = 220; // Deg
- public static double MIN_ANGLE = -220; // Deg
+ public static double MAX_ANGLE = 180; // Deg
+ public static double MIN_ANGLE = -200; // Deg
public static double CALIBRATION_OFFSET = 0.0; // TODO: find this at hardstop
public static final double FEEDFORWARD_KV = 0.06;
- public static final double NORMAL_CURRENT_LIMIT = 40.0; // A
+ public static final double NORMAL_CURRENT_LIMIT = 60.0; // A
public static final double CALIBRATION_CURRENT_LIMIT = 10.0; // A
public static final double CALIBRATION_CURRENT_THRESHOLD = 9.0; // A