Compare commits

..

2 Commits

3 changed files with 7 additions and 2 deletions
@@ -42,4 +42,4 @@ amcl:
z_rand: 0.2 z_rand: 0.2
z_short: 0.05 z_short: 0.05
scan_topic: /scan scan_topic: /scan
set_initial_pose: False # RViz 2D Pose Estimate 으로 사용자가 직접 init set_initial_pose: False # RViz 2D Pose Estimate 으로 사용자가 직접 init
@@ -52,7 +52,7 @@ def launch_setup(context, *args, **kwargs):
param_rewrites=param_substitutions, param_rewrites=param_substitutions,
convert_types=True), convert_types=True),
allow_substs=True) allow_substs=True)
load_nodes = GroupAction( load_nodes = GroupAction(
actions=[ actions=[
Node( Node(
@@ -6,6 +6,7 @@ from std_msgs.msg import String
import subprocess import subprocess
import json import json
import uuid
class LocalizationManager(Node): class LocalizationManager(Node):
def __init__(self): def __init__(self):
@@ -19,10 +20,14 @@ class LocalizationManager(Node):
) )
self.localization_process = None self.localization_process = None
self.config_received = False self.config_received = False
self.localization_session_id = uuid.uuid4().hex
self.declare_parameter('localization_mode', 'amcl') self.declare_parameter('localization_mode', 'amcl')
self.declare_parameter('database_path', '') self.declare_parameter('database_path', '')
self.localization_mode = self.get_parameter('localization_mode').value self.localization_mode = self.get_parameter('localization_mode').value
self.database_path = self.get_parameter('database_path').value self.database_path = self.get_parameter('database_path').value
self.localization_session_pub = self.create_publisher(String, '/localization_session_id', qos)
self.localization_session_pub.publish(String(data=self.localization_session_id))
self.get_logger().info(f'Localization session: {self.localization_session_id}')
self.create_subscription(String, '/vehicle_config', self.handle_config, qos_profile=qos) self.create_subscription(String, '/vehicle_config', self.handle_config, qos_profile=qos)