Tuned superstructure loop and added feed forwards.

Change-Id: Ia2e3a1746529a4c27395f2e9b6e875c5cddb7616
diff --git a/y2016/control_loops/python/BUILD b/y2016/control_loops/python/BUILD
index bd5c4bd..9396fea 100644
--- a/y2016/control_loops/python/BUILD
+++ b/y2016/control_loops/python/BUILD
@@ -56,11 +56,10 @@
     'intake.py',
   ],
   deps = [
-    ':polydrivetrain_lib',
     '//external:python-gflags',
     '//external:python-glog',
     '//frc971/control_loops/python:controls',
-  ]
+  ],
 )
 
 py_binary(
@@ -69,11 +68,11 @@
     'shoulder.py',
   ],
   deps = [
-    ':polydrivetrain_lib',
+    '//aos/common/util:py_trapezoid_profile',
     '//external:python-gflags',
     '//external:python-glog',
     '//frc971/control_loops/python:controls',
-  ]
+  ],
 )
 
 py_binary(
@@ -82,9 +81,64 @@
     'wrist.py',
   ],
   deps = [
-    ':polydrivetrain_lib',
+    '//aos/common/util:py_trapezoid_profile',
     '//external:python-gflags',
     '//external:python-glog',
     '//frc971/control_loops/python:controls',
-  ]
+  ],
+)
+
+py_library(
+  name = 'wrist_lib',
+  srcs = [
+    'wrist.py',
+  ],
+  deps = [
+    '//aos/common/util:py_trapezoid_profile',
+    '//external:python-gflags',
+    '//external:python-glog',
+    '//frc971/control_loops/python:controls',
+  ],
+)
+
+py_library(
+  name = 'shoulder_lib',
+  srcs = [
+    'shoulder.py',
+  ],
+  deps = [
+    '//aos/common/util:py_trapezoid_profile',
+    '//external:python-gflags',
+    '//external:python-glog',
+    '//frc971/control_loops/python:controls',
+  ],
+)
+
+py_library(
+  name = 'arm_lib',
+  srcs = [
+    'arm.py',
+  ],
+  deps = [
+    ':wrist_lib',
+    ':shoulder_lib',
+    '//external:python-gflags',
+    '//external:python-glog',
+    '//frc971/control_loops/python:controls',
+    '//aos/common/util:py_trapezoid_profile',
+  ],
+)
+py_binary(
+  name = 'arm',
+  srcs = [
+    'arm.py',
+  ],
+  deps = [
+    ':wrist_lib',
+    ':shoulder_lib',
+    '//external:python-gflags',
+    '//external:python-glog',
+    '//frc971/control_loops/python:controls',
+    '//aos/common/util:py_trapezoid_profile',
+  ],
 )