diff --git a/clever/launch/main_camera.launch b/clever/launch/main_camera.launch
index 19a865f1..b64d7f1b 100644
--- a/clever/launch/main_camera.launch
+++ b/clever/launch/main_camera.launch
@@ -26,7 +26,6 @@
-
diff --git a/clever/src/camera_markers.cpp b/clever/src/camera_markers.cpp
index a55b36a2..e5edb2d2 100644
--- a/clever/src/camera_markers.cpp
+++ b/clever/src/camera_markers.cpp
@@ -9,6 +9,7 @@
#include
#include
+#include
#include
#include
@@ -81,12 +82,15 @@ MarkerArray createMarkers() {
int main(int argc, char **argv)
{
- ros::init(argc, argv, "camera_markers");
+ ros::init(argc, argv, "camera_markers", ros::init_options::AnonymousName);
ros::NodeHandle nh, nh_priv("~");
- nh_priv.param("frame_id", camera_frame, "main_camera_optical");
nh_priv.param("scale", markers_scale, 1.0);
+ // wait for camera info
+ auto camera_info = ros::topic::waitForMessage("camera_info", nh);
+ camera_frame = camera_info->header.frame_id;
+
ros::Publisher markers_pub = nh.advertise("camera_markers", 1, true);
markers_pub.publish(createMarkers());