diff --git a/orange_bringup/launch/data_processing.launch.xml b/orange_bringup/launch/data_processing.launch.xml index 8d4bc04..abef442 100644 --- a/orange_bringup/launch/data_processing.launch.xml +++ b/orange_bringup/launch/data_processing.launch.xml @@ -21,6 +21,10 @@ + + + + diff --git a/orange_bringup/launch/with_ros2bag.launch.xml b/orange_bringup/launch/with_ros2bag.launch.xml index 65b00b3..41c267e 100644 --- a/orange_bringup/launch/with_ros2bag.launch.xml +++ b/orange_bringup/launch/with_ros2bag.launch.xml @@ -14,16 +14,6 @@ - - - - - - - - - - - + - + + + + + + + + - + + + + + + + + + - + + + + @@ -74,4 +82,14 @@ --> + + + + + + + + + + diff --git a/orange_bringup/orange_bringup/lonlat_to_odom.py b/orange_bringup/orange_bringup/lonlat_to_odom.py index c604822..63685aa 100755 --- a/orange_bringup/orange_bringup/lonlat_to_odom.py +++ b/orange_bringup/orange_bringup/lonlat_to_odom.py @@ -111,7 +111,8 @@ def conversion(self, coordinate, origin, theta): r_theta = theta * degree_to_radian h_x = math.cos(r_theta) * gps_x - math.sin(r_theta) * gps_y h_y = math.sin(r_theta) * gps_x + math.cos(r_theta) * gps_y - point = (-h_y, h_x) + point = (h_y, -h_x) + # point = (-h_y, h_x) # point = (h_y, -h_x) return point