How do I detect a game piece from motor current?
Goal: know when your intake has a game piece, without a beam break or limit switch, by watching the roller motor's current.
When a game piece jams against a spinning roller, the roller slows and the motor draws more current. Stator current is the current through the motor's windings, and it rises with the load. YAMS reads it with SmartMotorController.getStatorCurrent(), so you can turn "current has been high for a moment" into a Trigger.
This is a fallback for when there is no room or time for a real sensor. A beam break is more reliable, so ask for one if you can.
This page builds on the IntakeSubsystem from How do I set up an intake roller?
Measure your current
Simulation does not model a game piece, so this step has to be done on the real robot. Pick the threshold from your robot, not from this page.
Deploy the intake from How do I set up an intake roller? to the robot and open the motor's
current/statorvalue under NetworkTables > Mechanisms as a graph (Elastic, AdvantageScope or the Glass graph widget).Run the intake with nothing in it. Note the current once it is up to speed; a roller like this one often sits around 5 to 15 amps.
Feed it a game piece and let it jam. Note how high the current goes and how long it stays there.
Choose a threshold between the two, well clear of both: if it runs at 10 A empty and climbs to the 40 A limit with a game piece, try 25 A.
Check it: you have two readings, empty and jammed, at least 10 A apart, and a threshold between them.
Add the detection
Add a Debouncer and a method to the intake class. The Debouncer only reports true once the current has stayed over the threshold for 0.1 seconds, so the short spike when the motor starts does not count as a game piece. These lines are a fragment: they go in the IntakeSubsystem (or IntakeMechanism) class, next to the motor field.
import static org.wpilib.units.Units.Amps;
import org.wpilib.math.filter.Debouncer;
import org.wpilib.units.measure.Current;
// Over this, the roller is pushing against a game piece. Measured on our robot:
// about 10 A empty, 40 A (the current limit) with a game piece jammed.
private static final Current GAME_PIECE_CURRENT = Amps.of(25);
// True only after the current has stayed high for 0.1 seconds.
private final Debouncer gamePieceDebouncer = new Debouncer(0.1);
/** True once the roller has been pushing against a game piece for 0.1 seconds. */
public boolean hasGamePiece() {
return gamePieceDebouncer.calculate(motor.getStatorCurrent().gte(GAME_PIECE_CURRENT));
}Check it: the code builds.
Use it
Run the intake until it has a game piece, then stop.
/** Run the intake until a game piece is detected. */
public Command intakeUntilGamePiece() {
return intake().until(this::hasGamePiece);
}To use it as a Trigger elsewhere (for example to rumble the controller), wrap it: new Trigger(intake::hasGamePiece).
/** Run the intake until a game piece is detected. */
public Command intakeUntilGamePiece() {
return run(coroutine -> {
while (true) {
if (hasGamePiece()) {
intake.setVoltageSetpoint(Volts.of(0));
return;
}
intake.setVoltageSetpoint(Volts.of(8));
coroutine.yield();
}
}).named("Intake Until Game Piece");
}To use it as a Trigger elsewhere, wrap it: new Trigger(intake::hasGamePiece) with org.wpilib.command3.Trigger.
Check it: the code builds, and the intake runs when you press its button.
Check it
On the robot, graph
current/statorandhasGamePiece()together (publishhasGamePiece()withTelemetry.log, or watch the command end).Start the intake with nothing in it.
hasGamePiece()should stayfalse, even during the spike when the motor starts.Feed it a game piece.
hasGamePiece()should turntrueabout 0.1 seconds after the current climbs over the threshold, and the intake should stop.
If it did not work
It never detects the game piece. The threshold is too high, or the same as the current limit. Lower it toward the middle of your empty and jammed readings.
It detects a game piece when the intake starts. The start up spike lasts longer than 0.1 seconds. Raise the
Debouncertime to 0.2 or 0.25 seconds, or the threshold.It works with a full battery but not a low one. A tired battery slows the roller and changes the current. Use
setVoltagerather thansetfor the intake, and measure again with a used battery.
Read more
To feed that game piece into a shooter, see How do I shoot with a shooter?
For more on Debouncer, see the WPILib docs:
Last updated
Was this helpful?
