use the correct index for the robot position for the close points

varun7654 · Mar 7, 2023 · afd87ed · afd87ed
1 parent 54d0552
commit afd87ed
Show file tree

Hide file tree

Showing 3 changed files with 14 additions and 13 deletions.
diff --git a/.idea/misc.xml b/.idea/misc.xml
diff --git a/.idea/runConfigurations/DesktopLauncher.xml b/.idea/runConfigurations/DesktopLauncher.xml
diff --git a/core/src/main/com/dacubeking/autobuilder/gui/pathing/DrivenPathRenderer.java b/core/src/main/com/dacubeking/autobuilder/gui/pathing/DrivenPathRenderer.java
@@ -203,7 +203,8 @@ public void updatePoint(OrthographicCamera camera, Vector3 mousePos,
         synchronized (robotPositions) {
             float scale = AutoBuilder.getConfig().getPointScaleFactor();
             for (int i = 0; i < robotPositions.size(); i++) {
-                RobotPosition robotPosition = robotPositions.get(i).get(0);
+                ArrayList<RobotPosition> robotPositionsAtTime = (ArrayList<RobotPosition>) robotPositions.get(i);
+                RobotPosition robotPosition = robotPositionsAtTime.get(robotPositionsAtTime.size() - 1);
                 float len2 = mousePos.dst2((float) (robotPosition.x() * scale), (float) (robotPosition.y() * scale), 0);
                 if (len2 < maxDistance2) {
                     points.add(new CloseTrajectoryPoint(len2, this, i, 0));