Skip to content

Commit

Permalink
started pivot
Browse files Browse the repository at this point in the history
  • Loading branch information
Pouman1 committed Jan 27, 2025
1 parent ccf01aa commit 03cdb68
Show file tree
Hide file tree
Showing 5 changed files with 67 additions and 0 deletions.
6 changes: 6 additions & 0 deletions src/main/java/frc/robot/subsystems/pivot/Pivot.java
Original file line number Diff line number Diff line change
@@ -0,0 +1,6 @@
package frc.robot.subsystems.pivot;

import edu.wpi.first.wpilibj2.command.SubsystemBase;

public class Pivot extends SubsystemBase{
}
9 changes: 9 additions & 0 deletions src/main/java/frc/robot/subsystems/pivot/PivotConstants.java
Original file line number Diff line number Diff line change
@@ -0,0 +1,9 @@
package frc.robot.subsystems.pivot;

import java.util.concurrent.Flow.Publisher;

public class PivotConstants{
public static int pivotMotorID = 0; //not right
public static int stallLimit = 30; //not right
public static int freeLimit = 20; //not right
}
14 changes: 14 additions & 0 deletions src/main/java/frc/robot/subsystems/pivot/PivotIO.java
Original file line number Diff line number Diff line change
@@ -0,0 +1,14 @@
package frc.robot.subsystems.pivot;

import org.littletonrobotics.junction.AutoLog;

public interface PivotIO {
@AutoLog
public static class PivotIOInputs {
public double position = 0;
public double velocity = 0;
public double voltage = 0;
}
public default void setVoltage(double voltage) {};
public default void updateInputs(PivotIOInputs inputs) {};
}
33 changes: 33 additions & 0 deletions src/main/java/frc/robot/subsystems/pivot/PivotIOReal.java
Original file line number Diff line number Diff line change
@@ -0,0 +1,33 @@
package frc.robot.subsystems.pivot;

import com.revrobotics.AbsoluteEncoder;
import com.revrobotics.spark.SparkMax;
import com.revrobotics.spark.SparkBase.PersistMode;
import com.revrobotics.spark.SparkBase.ResetMode;
import com.revrobotics.spark.SparkLowLevel.MotorType;
import com.revrobotics.spark.config.SparkBaseConfig;
import com.revrobotics.spark.config.SparkMaxConfig;

public class PivotIOReal implements PivotIO {
private SparkMax pivotMotor = new SparkMax(PivotConstants.pivotMotorID, MotorType.kBrushless);
private SparkMaxConfig config = new SparkMaxConfig();
private AbsoluteEncoder encoder = pivotMotor.getAbsoluteEncoder();
public PivotIOReal() {
config.smartCurrentLimit(PivotConstants.stallLimit);
pivotMotor.configure(config, ResetMode.kResetSafeParameters, PersistMode.kPersistParameters);
pivotMotor.getStickyFaults();
}

@Override
public void setVoltage(double voltage) {
pivotMotor.setVoltage(voltage);
}

@Override
public void updateInputs(PivotIOInputs inputs) {
inputs.voltage = pivotMotor.getBusVoltage();
inputs.position = encoder.getPosition();
inputs.velocity = encoder.getVelocity();
}

}
5 changes: 5 additions & 0 deletions src/main/java/frc/robot/subsystems/pivot/PivotIOSim.java
Original file line number Diff line number Diff line change
@@ -0,0 +1,5 @@
package frc.robot.subsystems.pivot;

public class PivotIOSim {
private
}

0 comments on commit 03cdb68

Please sign in to comment.