Skip to content
FRCSoftware.org
This website is still in beta. If you find any errors, please report them here.

Kitbot Additional Motors

Remaining Motors

Section titled “Remaining Motors”

The kitbot has two additional motors that allow it to intake and shoot fuel. The IntakeLauncher motor powers the intake roller and the launcher flywheel while the Feeder motor feeds fuel into the hopper, into the launcher, or out of the intake. The IntakeLauncher motor will be on CAN Bus 0 with a CAN Id of 4 while the Feeder motor will be on CAN Bus 0 with a CAN Id of 5.

Inside of the Robot.java file create a motor controller instance for the IntakeLauncher and Feeder motors.

public TalonFX intakeLauncher = new TalonFX(4, CANBus.systemcore(0));
public TalonFX feeder = new TalonFX(5, CANBus.systemcore(0));

Simulating Additional Motors

Section titled “Simulating Additional Motors”

Like the drivetrain, the SingleFlywheelSim class is provided which abstracts much of the simulation code. The SingleFlywheelSim has different static methods for the LauncherFeeder and Intake motors which return instances of SingleFlywheelSim with settings for those specific motors.

Creating the SingleFlywheelSim instance for the LauncherFeeder motor will look like this

private SingleFlywheelSim intakeLauncherSim = SingleFlywheelSim.forIntakeLauncher(intakeLauncher);

Now try creating the SingleFlywheelSim instance for the Intake motor. This will instead use the forFeeder() method.

Solution
private SingleFlywheelSim feederSim = SingleFlywheelSim.forFeeder(feeder);

To make the simulated motor controllers update, the SingleFlywheelSim instances’ periodic() functions need to be called inside of simulationPeriodic().

intakeLauncherSim.periodic();
feederSim.periodic();

Fuel Sim

Section titled “Fuel Sim”

If the code was to be simulated at this point, the motors could be controlled using keyboard inputs and the resulting motor speeds could be viewed with a graph inside of Advantage Scope. While this is a functional solution, it can be made more interesting by taking advantage of Advantage Scope’s 3d tab. Advantage Scope’s 3d tab displays robots and game pieces inside of a game field using poses published from the robot code. This allows fuel to be shown entering or exiting the robot while is intaking or launching.

The FuelSim class is provided which takes the current state of the IntakeLauncher and Feeder motors and publishes new poses for the fuel to be visualized at in Advantage Scope. References to the IntakeLauncher and Feeder motors are given to the FuelSim class when the SingleFlywheelSim instances are created.

To make the FuelSim class function, its periodic() function needs to be called inside of simulationPeriodic().

FuelSim.periodic();

Check Up

Section titled “Check Up”

The Robot class is now completed! At this point your Robot class should look like this

Robot Solution
/**
 * The methods in this class are called automatically as described in the OpModeRobot documentation.
 * OpMode classes anywhere in the package (or sub-packages) where this class is located are
 * automatically registered to display in the Driver Station. If you change the name of this class
 * or the package after creating this project, you must also update the Main.java file in the
 * project.
 */
public class Robot extends OpModeRobot {


  private final int leftLeaderID = 0;
  public TalonFX leftLeader = new TalonFX(leftLeaderID, CANBus.systemcore(0));
  private TalonFX leftFollower = new TalonFX(1, CANBus.systemcore(0));


  private final int rightLeaderID = 2;
  public TalonFX rightLeader = new TalonFX(rightLeaderID, CANBus.systemcore(0));
  private TalonFX rightFollower = new TalonFX(3, CANBus.systemcore(0));


  public final DifferentialDrive drivetrain =
      new DifferentialDrive(leftLeader::setThrottle, rightLeader::setThrottle);


  private OnboardIMU imu = new OnboardIMU(MountOrientation.FLAT);


  private DrivetrainSim drivetrainSim = new DrivetrainSim(leftLeader, rightLeader);


  public TalonFX intakeLauncher = new TalonFX(4, CANBus.systemcore(0));
  public TalonFX feeder = new TalonFX(5, CANBus.systemcore(0));


  private SingleFlywheelSim intakeLauncherSim = SingleFlywheelSim.forIntakeLauncher(intakeLauncher);
  private SingleFlywheelSim feederSim = SingleFlywheelSim.forFeeder(feeder);




  /**
   * This function is run when the robot is first started up and should be used for any
   * initialization code.
   */
  public Robot() {
    var leftConfig = new TalonFXConfiguration();
    leftConfig.MotorOutput.withInverted(InvertedValue.Clockwise_Positive);
    leftLeader.getConfigurator().apply(leftConfig);
    leftFollower.getConfigurator().apply(leftConfig);


    leftFollower.setControl(new Follower(leftLeaderID, MotorAlignmentValue.Aligned));


    var rightConfig = new TalonFXConfiguration();
    rightConfig.MotorOutput.withInverted(InvertedValue.CounterClockwise_Positive);
    rightLeader.getConfigurator().apply(rightConfig);
    rightFollower.getConfigurator().apply(rightConfig);


    rightFollower.setControl(new Follower(rightLeaderID, MotorAlignmentValue.Aligned));
  }




  @Override
  public void simulationPeriodic() {
    drivetrainSim.periodic();
    intakeLauncherSim.periodic();
    feederSim.periodic();


    FuelSim.periodic();
  }

Additional Motors in Teleop

Section titled “Additional Motors in Teleop”

To control the new motors, the motors need to be commanded inside of the MyTeleop OpMode’s periodic() function. When the controller’s right bumper is pressed, the IntakeLauncher motor should have a throttle of 0.9 while the Feeder motor should have a throttle of 0.75. This will launch the fuel.

if (xboxController.getRightBumperButton()) {
  // launch
  robot.intakeLauncher.setThrottle(0.9);
  robot.feeder.setThrottle(0.75);

When the controller’s left bumper is pressed the IntakeLauncher motor should have a throttle of 0.8 while the Feeder motor should have a throttle of -1.0. This will intake the fuel.

} else if (xboxController.getLeftBumperButton()) {
  // intake
  robot.intakeLauncher.setThrottle(0.8);
  robot.feeder.setThrottle(-1.0);

When the controller’s A button is pressed the IntakeLauncher motor should have a throttle of -0.8 while the Feeder motor should have a throttle of 1.0. This will outake the fuel.

} else if (xboxController.getAButton()) {
  // outake
  robot.intakeLauncher.setThrottle(-0.8);
  robot.feeder.setThrottle(1.0);

When none of the previous button are pressed the IntakeLauncher should have a throttle of 0.0 while the Feeder motor should have a throttle of 0.0. This will stop the motors.

} else {
  // stop
  robot.intakeLauncher.setThrottle(0.0);
  robot.feeder.setThrottle(0.0);
}