Fixed theta not being set

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