add cgmres_nmpc test

PathTracking/cgmres_nmpc/cgmres_nmpc.py

@@ -585,8 +585,7 @@ def main():
 
     if show_animation:
         animation(plant_system, controller, dt)
-
-    plot_figures(plant_system, controller, iteration_num, dt)
+        plot_figures(plant_system, controller, iteration_num, dt)
 
 
 if __name__ == "__main__":

tests/test_cgmres_nmpc.py

@@ -0,0 +1,15 @@
+from unittest import TestCase
+
+import sys
+if 'cvxpy' in sys.modules:
+    sys.path.append("./PathTracking/cgmres_nmpc/")
+
+    from PathTracking.cgmres_nmpc import cgmres_nmpc as m
+
+    print(__file__)
+
+    class Test(TestCase):
+
+        def test1(self):
+            m.show_animation = False
+            m.main()