commit 4b9c531dff211109933731641054a00bbb040091
author Alex Perry <alex.perry96@gmail.com> Sat Mar 02 20:59:47 2019 -0800
committer Alex Perry <alex.perry96@gmail.com> Sat Mar 02 20:59:47 2019 -0800
tree f436cf012b3676456baf323100079c8bb6f8194b
parent 409993acf65b43f8960a4ac01d7923edce872fcc

Fix typo in libspline that led to no xva plan

Change-Id: Ie8dfcfb58a90b729cf9ae2d5887f7468db05b3b0

frc971/control_loops/drivetrain/libspline.cc

diff --git a/frc971/control_loops/drivetrain/libspline.cc b/frc971/control_loops/drivetrain/libspline.cc
index f931e59..1d7aa0b 100644
--- a/frc971/control_loops/drivetrain/libspline.cc
+++ b/frc971/control_loops/drivetrain/libspline.cc
@@ -197,9 +197,9 @@
   void TrajectoryGetPlanXVA(::std::vector<::Eigen::Matrix<double, 3, 1>> *vec,
                             double *X, double *V, double *A) {
     for (size_t i = 0; i < vec->size(); ++i) {
-      X[i] = (*vec)[0][0];
-      V[i] = (*vec)[0][1];
-      A[i] = (*vec)[0][2];
+      X[i] = (*vec)[i][0];
+      V[i] = (*vec)[i][1];
+      A[i] = (*vec)[i][2];
     }
   }