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',
+  ],
+)