updated characterization routine for krakens

blair-robot-project · May 16, 2024 · c38a0e1 · c38a0e1
1 parent 047acd4
commit c38a0e1
Show file tree

Hide file tree

Showing 3 changed files with 14 additions and 9 deletions.
diff --git a/src/main/kotlin/frc/team449/robot2024/Robot.kt b/src/main/kotlin/frc/team449/robot2024/Robot.kt
@@ -12,7 +12,7 @@ import frc.team449.robot2024.subsystems.Climber.Companion.createClimber
 import frc.team449.robot2024.subsystems.Feeder.Companion.createFeeder
 import frc.team449.robot2024.subsystems.Undertaker.Companion.createUndertaker
 import frc.team449.robot2024.subsystems.pivot.Pivot.Companion.createPivot
-import frc.team449.robot2024.subsystems.shooter.SpinShooter.Companion.createSpinShooter
+import frc.team449.robot2024.subsystems.shooter.SpinShooterKraken.Companion.createKrakenSpinShooter
 import frc.team449.system.AHRS
 import frc.team449.system.light.Light.Companion.createLight
 import monologue.Annotations.Log
@@ -49,7 +49,7 @@ class Robot : RobotBase(), Logged {
   val pivot = createPivot()
 
   @Log.NT
-  val shooter = createSpinShooter(this)
+  val shooter = createKrakenSpinShooter(this)
 
   @Log.NT
   val feeder = createFeeder()

diff --git a/src/main/kotlin/frc/team449/robot2024/subsystems/ControllerBindings.kt b/src/main/kotlin/frc/team449/robot2024/subsystems/ControllerBindings.kt
@@ -1,5 +1,6 @@
 package frc.team449.robot2024.subsystems
 
+import com.ctre.phoenix6.SignalLogger
 import edu.wpi.first.math.MathUtil
 import edu.wpi.first.math.geometry.Rotation2d
 import edu.wpi.first.units.Measure
@@ -46,13 +47,9 @@ class ControllerBindings(
       Volts.of(0.5).per(Seconds.of(1.0)),
       Volts.of(3.0),
       Seconds.of(10.0)
-    ),
+    ) { state -> SignalLogger.writeString("state", state.toString()) },
     Mechanism(
-      { voltage: Measure<Voltage> ->
-        run {
-          robot.shooter.setVoltage(voltage.`in`(Volts))
-        }
-      },
+      { voltage: Measure<Voltage> -> run { robot.shooter.setVoltage(voltage.`in`(Volts)) } },
       null,
       robot.shooter,
       "shooter"

diff --git a/src/main/kotlin/frc/team449/robot2024/subsystems/shooter/SpinShooterKraken.kt b/src/main/kotlin/frc/team449/robot2024/subsystems/shooter/SpinShooterKraken.kt
@@ -1,5 +1,6 @@
 package frc.team449.robot2024.subsystems.shooter
 
+import com.ctre.phoenix6.SignalLogger
 import com.ctre.phoenix6.configs.TalonFXConfiguration
 import com.ctre.phoenix6.controls.CoastOut
 import com.ctre.phoenix6.controls.VelocityVoltage
@@ -44,6 +45,13 @@ open class SpinShooterKraken(
   private val rightRateLimiter = SlewRateLimiter(SpinShooterKrakenConstants.BRAKE_RATE_LIMIT)
 
   init {
+    name = "Kraken Spin Shooter"
+
+    leftMotor.optimizeBusUtilization()
+    rightMotor.optimizeBusUtilization()
+    SignalLogger.setPath("/media/sda1/ctre-logs/")
+    SignalLogger.start()
+
     this.defaultCommand = coast()
   }
 
@@ -516,7 +524,7 @@ open class SpinShooterKraken(
   }
 
   companion object {
-    fun createSpinShooter(robot: Robot): SpinShooterKraken {
+    fun createKrakenSpinShooter(robot: Robot): SpinShooterKraken {
       val rightMotor = TalonFX(SpinShooterKrakenConstants.RIGHT_MOTOR_ID)
       val rightConfig = TalonFXConfiguration()
       rightConfig.CurrentLimits.StatorCurrentLimitEnable = true