copied Sawyer's unwrap change to 0.4b

murrayrm · murrayrm · commit 5c72d5ecd9c6 · 2011-04-01T04:46:30.000Z
diff --git a/src/ctrlutil.py b/src/ctrlutil.py
@@ -73,9 +73,9 @@ def unwrap(angle, period=2*pi):
     for k in range(len(angle)):
         # See if we need to account for angle wrapping
         if (angle[k] - last > period/2):
-           wrap = -period
+            wrap -= period
         elif (last - angle[k] > period/2):
-            wrap = period
+            wrap += period
 
         # Update the last value we have sene
         last = angle[k]
