add LQR planning

tests/test_LQR_planner.py

@@ -0,0 +1,15 @@
+from unittest import TestCase
+
+import sys
+sys.path.append("./PathPlanning/LQRPlanner")
+
+from PathPlanning.LQRPlanner import LQRPlanner as m
+
+print(__file__)
+
+
+class Test(TestCase):
+
+    def test1(self):
+        m.show_animation = False
+        m.main()