commit 3146b6417443f97b34442d61f81bff13e4e73be1
author Brian Silverman <brians> Thu Mar 20 14:52:46 2014 -0700
committer Brian Silverman <brians> Thu Mar 20 14:52:46 2014 -0700
tree 70bc350a78b9c750b44e0974e92a376d6e09c290
parent ff12c9f29785e3d387ac7c2e092acb3ffd361cb2

actually use the new matrix logging stuff

frc971/control_loops/drivetrain/drivetrain.cc

diff --git a/frc971/control_loops/drivetrain/drivetrain.cc b/frc971/control_loops/drivetrain/drivetrain.cc
index f7affb9..9f3b94d 100644
--- a/frc971/control_loops/drivetrain/drivetrain.cc
+++ b/frc971/control_loops/drivetrain/drivetrain.cc
@@ -126,6 +126,8 @@
       }
       loop_->UpdateObserver();
     }
+    ::Eigen::Matrix<double, 4, 1> E = loop_->R - loop_->X_hat;
+    LOG_MATRIX(DEBUG, "E", E);
   }
 
   double GetEstimatedRobotSpeed() {
@@ -148,10 +150,6 @@
       output->right_voltage = loop_->U(1, 0);
     }
   }
-  void PrintMotors() const {
-    ::Eigen::Matrix<double, 4, 1> E = loop_->R - loop_->X_hat;
-    LOG_MATRIX(DEBUG, "E", E);
-  }
 
  private:
   ::std::unique_ptr<StateFeedbackLoop<4, 2, 2>> loop_;