Pimpest/ros2-behaviors
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Fixed theta not being set

Browse Source
This commit is contained in:
Pimpest
2024-11-29 14:33:48 +01:00
parent ce51d7bf1b
commit 379fa62ebf
1 changed files with 1 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

1
mg_navigation/src/mg_move_server.cpp
View File

@ -88,6 +88,7 @@ private:
tf2::Matrix3x3(quaternion).getRPY(ro,phi,theta); tf2::Matrix3x3(quaternion).getRPY(ro,phi,theta);
point_mtx_.lock(); point_mtx_.lock();
point2d_ = {tf2_frame.translation.x,tf2_frame.translation.y}; point2d_ = {tf2_frame.translation.x,tf2_frame.translation.y};
theta_ = theta;
point_mtx_.unlock(); point_mtx_.unlock();