[utils] Add deadzone function (#74)

src/main/java/frc/robot/Utils.java

@@ -20,4 +20,14 @@ private Utils() {
   public static double now() {
     return WPIUtilJNI.now() * 1e+6;
   }
+
+  /**
+   * A function to apply a 0.05 deadzone.
+   *
+   * @param value The value to apply a deadzone to.
+   * @return The value with the applied deadzone.
+   */
+  public static double deadzone(double value) {
+    return (Math.abs(value) > 0.05) ? value : 0;
+  }
 }

src/test/java/frc/robot/TestUtils.java

@@ -24,4 +24,13 @@ void testNow() {
     SimHooks.stepTiming(3);
     assertEquals(Utils.now(), 3.0E12);
   }
+
+  @Test
+  void testDeadzone() {
+    var val1 = 0.001;
+    assertEquals(Utils.deadzone(val1), 0);
+
+    var val2 = 0.5;
+    assertEquals(Utils.deadzone(val2), val2);
+  }
 }