Compare commits
2 Commits
8d6c0222ba
..
main
| Author | SHA1 | Date | |
|---|---|---|---|
| 8a71804a29 | |||
| 1a0f1d18ba |
@@ -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)
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user