finished arm constants

TitaniumTitans · Feb 7, 2024 · ed7ccde · ed7ccde
1 parent 8a5464d
commit ed7ccde
Showing 1 changed file with 6 additions and 3 deletions.
diff --git a/src/main/java/frc/robot/subsystems/arm/ArmIOPrototype.java b/src/main/java/frc/robot/subsystems/arm/ArmIOPrototype.java
@@ -58,9 +58,12 @@ public ArmIOPrototype() {
         false,
         m_wrist,
         0)
-        .addP(0.0)
-        .addI(0.0)
-        .addD(0.0)
+        .addP(ArmConstants.WRIST_KP)
+        .addI(ArmConstants.WRIST_KI)
+        .addD(ArmConstants.WRIST_KD)
+        .addKS(ArmConstants.WRIST_KS)
+        .addKV(ArmConstants.WRIST_KV)
+        .addKG(ArmConstants.WRIST_KG, GravityTypeValue.Arm_Cosine)
         .build();
 
     m_shoulderReqPID = new PositionVoltage(0).withSlot(0);