2022-01-12 06:00:44 +05:30
|
|
|
// Copyright (c) FIRST and other WPILib contributors.
|
|
|
|
|
// Open Source Software; you can modify and/or share it under the terms of
|
|
|
|
|
// the WPILib BSD license file in the root directory of this project.
|
|
|
|
|
|
|
|
|
|
package frc4388.robot.subsystems;
|
|
|
|
|
|
2022-01-13 18:06:38 -07:00
|
|
|
import com.ctre.phoenix.motorcontrol.can.WPI_TalonFX;
|
|
|
|
|
|
2022-01-12 06:00:44 +05:30
|
|
|
import edu.wpi.first.wpilibj2.command.SubsystemBase;
|
|
|
|
|
|
|
|
|
|
public class Intake extends SubsystemBase {
|
|
|
|
|
|
2022-01-13 18:06:38 -07:00
|
|
|
private WPI_TalonFX m_intakeMotor;
|
|
|
|
|
private WPI_TalonFX m_extenderMotor;
|
2022-01-12 06:00:44 +05:30
|
|
|
|
2022-01-13 18:06:38 -07:00
|
|
|
/** Creates a new Intake. */
|
2022-01-20 18:08:31 -07:00
|
|
|
public Intake(WPI_TalonFX intakeMotor, WPI_TalonFX extenderMotor) {
|
|
|
|
|
m_intakeMotor = intakeMotor;
|
|
|
|
|
m_extenderMotor = extenderMotor;
|
2022-01-12 06:00:44 +05:30
|
|
|
}
|
|
|
|
|
|
|
|
|
|
@Override
|
|
|
|
|
public void periodic() {
|
|
|
|
|
// This method will be called once per scheduler run
|
|
|
|
|
}
|
|
|
|
|
|
2022-01-13 05:41:53 +05:30
|
|
|
public void runWithTriggers(double leftTrigger, double rightTrigger) {
|
2022-01-13 05:50:39 +05:30
|
|
|
m_intakeMotor.set(rightTrigger - leftTrigger);
|
2022-01-12 06:34:13 +05:30
|
|
|
}
|
|
|
|
|
|
2022-01-13 05:50:39 +05:30
|
|
|
public void runExtender(boolean extended) {
|
2022-01-20 18:08:31 -07:00
|
|
|
m_extenderMotor.set(extended ? 1 : -1);
|
2022-01-12 06:34:13 +05:30
|
|
|
}
|
2022-01-12 06:00:44 +05:30
|
|
|
}
|
2022-01-20 18:08:31 -07:00
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
Function toggle extender
|
|
|
|
|
bool = !bool
|
|
|
|
|
Configure limit switches forward and reverse
|
|
|
|
|
*/
|