add units compatible clamp function

build.gradle

@@ -39,7 +39,7 @@ publishing {
 		release(MavenPublication) {
 			groupId = 'org.team4099'
 			artifactId = 'falconutils'
-			version = '1.1.11'
+			version = '1.1.12'
 
 			from(components["kotlin"])
 		}

src/main/kotlin/org/team4099/lib/math/MathUtil.kt

@@ -0,0 +1,9 @@
+package org.team4099.lib.math
+
+import edu.wpi.first.math.MathUtil
+import org.team4099.lib.units.UnitKey
+import org.team4099.lib.units.Value
+
+fun <K : UnitKey> clamp(value: Value<K>, lowerBound: Value<K>, upperBound: Value<K>): Value<K> {
+  return Value(MathUtil.clamp(value.value, lowerBound.value, upperBound.value))
+}

src/test/kotlin/team4099/math/MathTest.kt

@@ -0,0 +1,34 @@
+package team4099.math
+
+import org.junit.jupiter.api.Assertions.assertEquals
+import org.junit.jupiter.api.Test
+import org.team4099.lib.math.clamp
+import org.team4099.lib.units.base.inInches
+import org.team4099.lib.units.base.inches
+
+class MathTest {
+
+  @Test
+  fun noClamp() {
+    val value = 5.0.inches
+    val lowerBound = 0.0.inches
+    val upperBound = 10.0.inches
+    assertEquals(clamp(value, lowerBound, upperBound).inInches, value.inInches)
+  }
+
+  @Test
+  fun upperClamp() {
+    val value = 15.0.inches
+    val lowerBound = 0.0.inches
+    val upperBound = 10.0.inches
+    assertEquals(clamp(value, lowerBound, upperBound).inInches, upperBound.inInches)
+  }
+
+  @Test
+  fun lowerClamp() {
+    val value = -5.0.inches
+    val lowerBound = 0.0.inches
+    val upperBound = 10.0.inches
+    assertEquals(clamp(value, lowerBound, upperBound).inInches, lowerBound.inInches)
+  }
+}