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);