From 379fa62ebf865508672c1dc8cf3448e64fc3d865 Mon Sep 17 00:00:00 2001
From: Pimpest <82343504+Pimpest@users.noreply.github.com>
Date: Fri, 29 Nov 2024 14:33:48 +0100
Subject: [PATCH] Fixed theta not being set

---
 mg_navigation/src/mg_move_server.cpp | 1 +
 1 file changed, 1 insertion(+)

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