diff --git a/src/main/kotlin/com/frcteam3636/frc2024/subsystems/arm/Arm.kt b/src/main/kotlin/com/frcteam3636/frc2024/subsystems/arm/Arm.kt index 75b230a..f7cefc4 100644 --- a/src/main/kotlin/com/frcteam3636/frc2024/subsystems/arm/Arm.kt +++ b/src/main/kotlin/com/frcteam3636/frc2024/subsystems/arm/Arm.kt @@ -87,6 +87,13 @@ object Arm : Subsystem { io.pivotToPosition(inputs.position) })!! + fun setSpeed(percent: Double) = + startEnd({ + io.setVoltage(Volts.of(percent * 12.0)) + }, { + io.setVoltage(Volts.of(0.0)) + })!! + fun sysIdQuasistatic(direction: Direction) = sysID.quasistatic(direction)!!