diff --git a/launch/nodelet.launch b/launch/nodelet.launch
index 646f23a..345dd04 100644
--- a/launch/nodelet.launch
+++ b/launch/nodelet.launch
@@ -112,7 +112,7 @@
diff --git a/src/camera_nodelet.cpp b/src/camera_nodelet.cpp
index 1c1a7d8..f12f020 100644
--- a/src/camera_nodelet.cpp
+++ b/src/camera_nodelet.cpp
@@ -97,7 +97,7 @@ ifm3d_ros::CameraNodelet::onInit()
this->xmlrpc_port_ = static_cast(xmlrpc_port);
this->schema_mask_ = static_cast(schema_mask);
- this->frame_id_ = frame_id_base + "_link";
+ this->frame_id_ = frame_id_base;
this->optical_frame_id_ = frame_id_base + "_optical_link";
//-------------------