FairportRobotics
/
RoboLib
mirror of https://github.com/FairportRobotics/RoboLib.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Reorganization

This commit is contained in:
Tyler Wilcox 2026-01-30 22:25:01 -05:00
parent 8defb590f4
commit 817515901c
3 changed files with 23 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
lib/src/main/java/org/fairportrobotics/frc/robolib/drivesystems/swerve/SwerveBuilder.java
View File

@ -57,8 +57,8 @@ public class SwerveBuilder {
return this;
}
public SwerveDriveSubsystem build() {
return new SwerveDriveSubsystem(pigeonId, canBusObj, maxLinearVelMetersSecond, maxAngularVelRadiansSecond,
public SwerveDriveSystem build() {
return new SwerveDriveSystem(pigeonId, canBusObj, maxLinearVelMetersSecond, maxAngularVelRadiansSecond,
modules.toArray(size -> new SwerveModule[size]));
}

12
lib/src/main/java/org/fairportrobotics/frc/robolib/drivesystems/swerve/SwerveDriveSubsystem.java → lib/src/main/java/org/fairportrobotics/frc/robolib/drivesystems/swerve/SwerveDriveSystem.java
View File

@ -16,9 +16,10 @@ import edu.wpi.first.math.kinematics.SwerveDriveKinematics;
import edu.wpi.first.math.kinematics.SwerveModulePosition;
import edu.wpi.first.math.kinematics.SwerveModuleState;
import edu.wpi.first.units.measure.Angle;
import edu.wpi.first.wpilibj2.command.Subsystem;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
public class SwerveDriveSubsystem extends SubsystemBase{
public class SwerveDriveSystem implements Subsystem{
private SwerveDriveKinematics driveKiniematics;
private ChassisSpeeds chassisSpeeds;
@ -35,7 +36,7 @@ public class SwerveDriveSubsystem extends SubsystemBase{
private double mLastSimTime = 0;
public SwerveDriveSubsystem(int pigeonId, CANBus canBus, double maxLinearVelMetersSecond, double maxAngularVelRadiansSecond, SwerveModule... modules){
public SwerveDriveSystem(int pigeonId, CANBus canBus, double maxLinearVelMetersSecond, double maxAngularVelRadiansSecond, SwerveModule... modules){
MAX_LINEAR_SPEED = maxLinearVelMetersSecond;
MAX_ANGULAR_SPEED = maxAngularVelRadiansSecond;
@ -54,7 +55,6 @@ public class SwerveDriveSubsystem extends SubsystemBase{
@Override
public void periodic() {
super.periodic();
SwerveModuleState[] moduleStates = driveKiniematics.toSwerveModuleStates(chassisSpeeds);
for(int i=0; i<modules.length;i++){
@ -71,8 +71,6 @@ public class SwerveDriveSubsystem extends SubsystemBase{
@Override
public void simulationPeriodic() {
super.simulationPeriodic();
double deltaTimeSecond = (mLastSimTime - Utils.getCurrentTimeSeconds());
if(mLastSimTime != 0){
@ -107,6 +105,10 @@ public class SwerveDriveSubsystem extends SubsystemBase{
return gyro.getRoll().getValue();
}
public Pigeon2 getGyro(){
return gyro;
}
public void setChassisSpeed(ChassisSpeeds chassisSpeeds){
this.setChassisSpeed(chassisSpeeds, new Translation2d());
}

14
lib/src/main/java/org/fairportrobotics/frc/robolib/drivesystems/swerve/SwerveModule.java
View File

@ -39,8 +39,10 @@ public class SwerveModule {
private TalonFX driveMotor;
private VelocityVoltage driveRequest = new VelocityVoltage(0);
private TalonFX steerMotor;
private MotionMagicVoltage steerRequest = new MotionMagicVoltage(0);
private CANcoder steerEncoder;
private String moduleName;
@ -138,6 +140,18 @@ public class SwerveModule {
requestedModuleState = state;
}
public TalonFX getSteerMotor(){
return steerMotor;
}
public TalonFX getDriveMotor(){
return driveMotor;
}
public CANcoder getSteerEncoder(){
return steerEncoder;
}
public SwerveModuleState getRequestedModuleState(){
return requestedModuleState;
}