@@ -85,7 +85,9 @@ public class Swerve extends SwerveDrivetrain implements Subsystem, SelfChecked {
85
85
null , // Use default ramp rate (1 V/s)
86
86
Volts .of (4 ), // Reduce dynamic step voltage to 4 V to prevent brownout
87
87
null , // Use default timeout (10 s)
88
- state -> DogLog .log ("SysId Translation Routine State" , state .toString ())),
88
+ state ->
89
+ SignalLogger .writeString (
90
+ "Swerve SysId Translation Routine State" , state .toString ())),
89
91
new SysIdRoutine .Mechanism (
90
92
volts -> setControl (_translationSysIdRequest .withVolts (volts )), null , this ));
91
93
@@ -96,7 +98,8 @@ public class Swerve extends SwerveDrivetrain implements Subsystem, SelfChecked {
96
98
null , // Use default ramp rate (1 V/s)
97
99
Volts .of (7 ), // Use dynamic voltage of 7 V
98
100
null , // Use default timeout (10 s)
99
- state -> DogLog .log ("SysId Steer Routine State" , state .toString ())),
101
+ state ->
102
+ SignalLogger .writeString ("Swerve SysId Steer Routine State" , state .toString ())),
100
103
new SysIdRoutine .Mechanism (
101
104
volts -> setControl (_steerSysIdRequest .withVolts (volts )), null , this ));
102
105
@@ -109,13 +112,15 @@ public class Swerve extends SwerveDrivetrain implements Subsystem, SelfChecked {
109
112
// This is in radians per second, but SysId only supports "volts"
110
113
Volts .of (Math .PI ),
111
114
null , // Use default timeout (10 s)
112
- state -> DogLog .log ("SysId Rotation Routine State" , state .toString ())),
115
+ state ->
116
+ SignalLogger .writeString (
117
+ "Swerve SysId Rotation Routine State" , state .toString ())),
113
118
new SysIdRoutine .Mechanism (
114
119
output -> {
115
120
// output is actually radians per second, but SysId only supports "volts"
116
121
setControl (_rotationSysIdRequest .withRotationalRate (output .in (Volts )));
117
122
// also log the requested output for SysId
118
- SignalLogger .writeDouble ("Rotational Rate" , output .in (Volts ));
123
+ SignalLogger .writeDouble ("Swerve Rotational Rate" , output .in (Volts ));
119
124
},
120
125
null ,
121
126
this ));
@@ -467,11 +472,12 @@ public void periodic() {
467
472
468
473
@ Override
469
474
public void simulationPeriodic () {
470
- _visionSystemSim .update (getPose ()); // TODO
475
+ _visionSystemSim .update (getPose ()); // TODO: this might require a seperate wheel-only odom
471
476
}
472
477
478
+ // TODO: add self check routines
473
479
private Command selfCheckModule (String name , SwerveModule module ) {
474
- return shiftSequence (); // TODO
480
+ return shiftSequence ();
475
481
}
476
482
477
483
@ Override
0 commit comments