From 955af401f09b353b4ea824d8dc2dd5984d2837a8 Mon Sep 17 00:00:00 2001
From: Jose Luis Blanco-Claraco <joseluisblancoc@gmail.com>
Date: Tue, 1 Oct 2024 16:17:28 +0200
Subject: [PATCH] viz animations: draw vehicle frame for visual reference

---
 mrpt_path_planning/src/algos/viz.cpp | 2 ++
 1 file changed, 2 insertions(+)

diff --git a/mrpt_path_planning/src/algos/viz.cpp b/mrpt_path_planning/src/algos/viz.cpp
index 4d7d2c6..eebafa7 100644
--- a/mrpt_path_planning/src/algos/viz.cpp
+++ b/mrpt_path_planning/src/algos/viz.cpp
@@ -104,6 +104,8 @@ void mpp::viz_nav_plan_animation(
         *glRobotShape);
     glRobotShape->setColor_u8(0xff, 0x00, 0x00, 0xff);  // RGB+A
     glVeh->insert(glRobotShape);
+    auto glVehCorner = mrpt::opengl::stock_objects::CornerXYZ(0.3);
+    glVeh->insert(glVehCorner);
 
     glVehFrame->insert(glVeh);