Added a working elqr using a modified first step cost
It converges!!!
Change-Id: I78c0743c8a5d0abbf1994697bdd5b91b10687cf6
diff --git a/y2014/control_loops/python/BUILD b/y2014/control_loops/python/BUILD
index 84e73a5..3802cb3 100644
--- a/y2014/control_loops/python/BUILD
+++ b/y2014/control_loops/python/BUILD
@@ -62,3 +62,15 @@
'//frc971/control_loops/python:controls',
]
)
+
+py_binary(
+ name = 'extended_lqr',
+ srcs = [
+ 'extended_lqr.py',
+ ],
+ deps = [
+ '//external:python-gflags',
+ '//external:python-glog',
+ '//frc971/control_loops/python:controls',
+ ],
+)