File tree Expand file tree Collapse file tree 1 file changed +3
-4
lines changed
src/main/java/frc/robot/subsystems Expand file tree Collapse file tree 1 file changed +3
-4
lines changed Original file line number Diff line number Diff line change @@ -98,12 +98,11 @@ public void setDesiredState(SwerveModuleState desiredState) {
98
98
correctedDesiredState .angle = desiredState .angle .plus (Rotation2d .fromRadians (m_chassisAngularOffset ));
99
99
100
100
// Optimize the reference state to avoid spinning further than 90 degrees.
101
- SwerveModuleState optimizedDesiredState = SwerveModuleState .optimize (correctedDesiredState ,
102
- new Rotation2d (m_turningEncoder .getPosition ()));
101
+ correctedDesiredState .optimize (new Rotation2d (m_turningEncoder .getPosition ()));
103
102
104
103
// Command driving and turning SPARKS MAX towards their respective setpoints.
105
- m_drivingPIDController .setReference (optimizedDesiredState .speedMetersPerSecond , ControlType .kVelocity );
106
- m_turningPIDController .setReference (optimizedDesiredState .angle .getRadians (), ControlType .kPosition );
104
+ m_drivingPIDController .setReference (correctedDesiredState .speedMetersPerSecond , ControlType .kVelocity );
105
+ m_turningPIDController .setReference (correctedDesiredState .angle .getRadians (), ControlType .kPosition );
107
106
108
107
m_desiredState = desiredState ;
109
108
}
You can’t perform that action at this time.
0 commit comments