Fix odometry trail for pose arrays of changing length

Mechanical-Advantage · Oct 30, 2023 · 1eccd59 · 1eccd59
1 parent 77e7d33
commit 1eccd59
Showing 1 changed file with 6 additions and 1 deletion.
diff --git a/src/hub/tabControllers/OdometryController.ts b/src/hub/tabControllers/OdometryController.ts
@@ -284,7 +284,9 @@ export default class OdometryController extends TimelineVizController {
                   rotationConversion
                 );
                 poses.forEach((pose, index) => {
-                  trailsTemp[index].push(pose.translation);
+                  if (index < trailsTemp.length) {
+                    trailsTemp[index].push(pose.translation);
+                  }
                 });
                 while (dataIndex < data!.timestamps.length && data!.timestamps[dataIndex] < timestamp) {
                   dataIndex++;
@@ -293,6 +295,9 @@ export default class OdometryController extends TimelineVizController {
             }
           } else if (typeof field.sourceType === "string") {
             let addTrail = (key: string, trailIndex = 0) => {
+              if (trailIndex >= trailsTemp.length) {
+                return;
+              }
               let xData = window.log.getNumber(
                 key + "/translation/x",
                 timestamps[0],