feat(sim): add orange cone marker for cv cones

DUT-Racing · Oct 16, 2021 · 947aa3d · 947aa3d
1 parent c360ce1
commit 947aa3d
Showing 1 changed file with 5 additions and 1 deletion.
diff --git a/src/simulation/simulator/src/sim_viz.cpp b/src/simulation/simulator/src/sim_viz.cpp
@@ -340,8 +340,12 @@ void SimViz::addWorldStateMarker(const cv_msgs::msg::Cone &cone, u_int32_t id, v
         marker.color.r = 1.0;
         marker.color.g = 1.0;
         marker.color.b = 0.0;
-    } else {
+    } else if (cone_type == cv_msgs::msg::Cone::ORANGE) {
         marker.color.r = 1.0;
+        marker.color.g = static_cast<float>(165.0 / 255.0);
+        marker.color.b = 0.0;
+    } else {
+        marker.color.r = 0.0;
         marker.color.g = 0.0;
         marker.color.b = 0.0;
     }