[maxswerve/swerveutils] Fix sign bug

Author: epanov1602

examples/maxswerve/swerveutils.py

@@ -41,7 +41,7 @@ def stepTowardsCircular(current: float, target: float, stepsize: float) -> float
     current = wrapAngle(current)
     target = wrapAngle(target)
 
-    stepDirection = math.copysign(target - current, 1)
+    stepDirection = math.copysign(1, target - current)
     difference = abs(current - target)
 
     if difference <= stepsize:

examples/maxswerve/tests/test_swerveutils.py

@@ -0,0 +1,8 @@
+import swerveutils
+
+def test_stepTowardsCircular1():
+    current = 0.6408134451373411
+    stepsize = 0.3455804605358387
+    target = 0.0  # stepping towards zero direction
+    result = swerveutils.stepTowardsCircular(current=current, stepsize=stepsize, target=target)
+    assert abs(result) < abs(current), f"swerveutils: why stepping from {current} to {target} results in {result}?"