ros2 launch robot_controll_pkg bringup_launch.py
ros2 topic pub /start_dock custom_interfaces/DockTrigger "{trigger: true, wsnumber: 1}" --once
ros2 launch global_manager_pkg global_planer_launch.py
ros2 topic pub /dock_goal std_msgs/msg/String "data: 'ws_1'" --once
ros2 topic pub /start_undock std_msgs/msg/Bool "data: true" --once