commit fbceb1ca498ae16a39382294fdf98dd53f3ed1d2
author Austin Schuh <austin.linux@gmail.com> Sat Mar 11 22:10:57 2017 -0800
committer Austin Schuh <austin.linux@gmail.com> Wed Mar 22 20:24:04 2017 -0700
tree cfa99611644bf205af62c21181b067e15d09c382
parent d5ccb8667ac54a10189b455ad0d3786c5cb87779

Calibrated the hood, indexer and drivetrain

Change-Id: I83f1043a0131f9c4dc414b88325667afc3ee514b

y2017/control_loops/python/hood.py

diff --git a/y2017/control_loops/python/hood.py b/y2017/control_loops/python/hood.py
index 40d3473..d42620a 100755
--- a/y2017/control_loops/python/hood.py
+++ b/y2017/control_loops/python/hood.py
@@ -57,7 +57,7 @@
 
     # Moment of inertia, measured in CAD.
     # Extra mass to compensate for friction is added on.
-    self.J = 0.08 + \
+    self.J = 0.08 + 1.1 + \
              self.big_gear_inertia * ((self.G1 / self.G) ** 2) + \
              self.big_gear_inertia * ((self.G2 / self.G) ** 2) + \
              self.motor_inertia * ((1.0 / self.G) ** 2.0)
@@ -94,8 +94,8 @@
     glog.debug(repr(self.A_continuous))
 
     # Calculate the LQR controller gain
-    q_pos = 0.05
-    q_vel = 10.0
+    q_pos = 0.006
+    q_vel = 0.30
     self.Q = numpy.matrix([[(1.0 / (q_pos ** 2.0)), 0.0],
                            [0.0, (1.0 / (q_vel ** 2.0))]])