diff --git a/mg_navigation/src/mg_move_server.cpp b/mg_navigation/src/mg_move_server.cpp
index f985de6..f950fba 100644
--- a/mg_navigation/src/mg_move_server.cpp
+++ b/mg_navigation/src/mg_move_server.cpp
@@ -88,6 +88,7 @@ private:
             tf2::Matrix3x3(quaternion).getRPY(ro,phi,theta);
             point_mtx_.lock();
             point2d_ = {tf2_frame.translation.x,tf2_frame.translation.y};
+            theta_ = theta;
 
             point_mtx_.unlock();