Made KF data available to polydrivetrain.
Change-Id: I067d0d05b9fc32d6ad50fbd35a6e9ad07b63f20d
diff --git a/y2014/control_loops/drivetrain/polydrivetrain.h b/y2014/control_loops/drivetrain/polydrivetrain.h
index d57ff4c..5cd7fff 100644
--- a/y2014/control_loops/drivetrain/polydrivetrain.h
+++ b/y2014/control_loops/drivetrain/polydrivetrain.h
@@ -32,7 +32,7 @@
// Torque constant
static constexpr double Kt = drivetrain::kT;
- PolyDrivetrain();
+ PolyDrivetrain(StateFeedbackLoop<7, 2, 3> *kf);
int controller_index() const { return loop_->controller_index(); }
@@ -65,6 +65,7 @@
void SendMotors(::y2014::control_loops::DrivetrainQueue::Output *output);
private:
+ StateFeedbackLoop<7, 2, 3> *kf_;
const ::aos::controls::HPolytope<2> U_Poly_;
::std::unique_ptr<StateFeedbackLoop<2, 2, 2>> loop_;