turtlebot / turtlebot4_simulator

TurtleBot 4 Simulator packages
Apache License 2.0
67 stars 39 forks source link

No Lidar data in Rviz except for warehouse world #55

Closed HyydenJakcz closed 10 months ago

HyydenJakcz commented 11 months ago

Please provide the following information:

To Reproduce Provide the steps to reproduce:

  1. run simulation with slam on a different world than the default
  2. run rviz
  3. see the error

Other notes if I copy the contents of other world files into the warehouse world and change the world name, it is able to visualize the lidar rays in rviz.

hilary-luo commented 11 months ago

@HyydenJakcz when you are filling out the issue template please always provide the exact commands that you are running and the exact output from the terminal. I do not have enough information to tell you exactly what you are doing wrong but my best guess is that you are not following the instructions for a custom world. See the instructions available here: https://turtlebot.github.io/turtlebot4-user-manual/tutorials/navigation.html?highlight=custom%20world#launching-navigation

If you are using a custom world you will need to build the turtlebot4_simulator package from source and place your world file alongside the others. You will then need to create a map for it and pass both the world name and the map file path in as launch arguments.

For example:

ros2 launch turtlebot4_ignition_bringup turtlebot4_ignition.launch.py nav2:=true slam:=false localization:=true rviz:=true world:=classroom map:=path/to/classroom.yaml

This is how to launch navigation, it is similar if you are trying to run SLAM but you don't need to pass a map since you are generating the map.

HyydenJakcz commented 11 months ago

the command I run when trying to map out my custom world is: ros2 launch turtlebot4_ignition_bringup turtlebot4_ignition.launch.py slam:=true rviz:=true world:=office

hilary-luo commented 11 months ago

@HyydenJakcz Have you built the package from source and placed the world in the folder as indicated in my last message and at that page that I linked?

HyydenJakcz commented 11 months ago

Yes, I did. I still does not work

hilary-luo commented 11 months ago

And you have built the workspace without errors and sourced it in your terminal? If not, make sure to do that first. Once you have, if you are still having problems please provide the full terminal output from the terminal. This is another thing that you need to always include when creating an issue because without it, I can only guess about what is happening on your system.

Can you also please confirm what you do or do not see in gazebo as well as rviz?

HyydenJakcz commented 11 months ago

I get no errors from building the workspace, and rviz still has no map data. Here is the terminal output:

[INFO] [launch]: All log files can be found below /home/shananda/.ros/log/2023-11-01-09-31-24-559737-shananda-Legion-5-15ACH6A-19214
[INFO] [launch]: Default logging verbosity is set to INFO
ign_args is deprecated, migrate to gz_args!
[INFO] [ruby $(which ign) gazebo-1]: process started with pid [19218]
[INFO] [parameter_bridge-2]: process started with pid [19220]
[INFO] [robot_state_publisher-3]: process started with pid [19223]
[INFO] [joint_state_publisher-4]: process started with pid [19225]
[INFO] [robot_state_publisher-5]: process started with pid [19228]
[INFO] [static_transform_publisher-6]: process started with pid [19230]
[INFO] [create-7]: process started with pid [19232]
[INFO] [create-8]: process started with pid [19234]
[INFO] [parameter_bridge-9]: process started with pid [19236]
[INFO] [parameter_bridge-10]: process started with pid [19238]
[INFO] [parameter_bridge-11]: process started with pid [19242]
[INFO] [parameter_bridge-12]: process started with pid [19246]
[INFO] [parameter_bridge-13]: process started with pid [19248]
[INFO] [parameter_bridge-14]: process started with pid [19250]
[INFO] [parameter_bridge-15]: process started with pid [19252]
[INFO] [parameter_bridge-16]: process started with pid [19254]
[INFO] [parameter_bridge-17]: process started with pid [19277]
[INFO] [parameter_bridge-18]: process started with pid [19285]
[INFO] [parameter_bridge-19]: process started with pid [19287]
[INFO] [parameter_bridge-20]: process started with pid [19291]
[INFO] [parameter_bridge-21]: process started with pid [19325]
[INFO] [parameter_bridge-22]: process started with pid [19372]
[INFO] [parameter_bridge-23]: process started with pid [19387]
[INFO] [parameter_bridge-24]: process started with pid [19398]
[INFO] [parameter_bridge-25]: process started with pid [19425]
[INFO] [parameter_bridge-26]: process started with pid [19458]
[INFO] [parameter_bridge-27]: process started with pid [19492]
[INFO] [parameter_bridge-28]: process started with pid [19521]
[INFO] [parameter_bridge-29]: process started with pid [19541]
[INFO] [turtlebot4_node-30]: process started with pid [19555]
[INFO] [turtlebot4_ignition_hmi_node-31]: process started with pid [19564]
[INFO] [spawner-32]: process started with pid [19600]
[INFO] [hazards_vector_publisher-33]: process started with pid [19604]
[INFO] [ir_intensity_vector_publisher-34]: process started with pid [19612]
[INFO] [motion_control-35]: process started with pid [19636]
[INFO] [wheel_status_publisher-36]: process started with pid [19648]
[INFO] [mock_publisher-37]: process started with pid [19669]
[INFO] [robot_state-38]: process started with pid [19671]
[INFO] [kidnap_estimator_publisher-39]: process started with pid [19682]
[INFO] [ui_mgr-40]: process started with pid [19714]
[INFO] [pose_republisher_node-41]: process started with pid [19720]
[INFO] [sensors_node-42]: process started with pid [19737]
[INFO] [interface_buttons_node-43]: process started with pid [19744]
[INFO] [static_transform_publisher-44]: process started with pid [19761]
[INFO] [static_transform_publisher-45]: process started with pid [19798]
[INFO] [sync_slam_toolbox_node-46]: process started with pid [19803]
[INFO] [rviz2-47]: process started with pid [19819]
[parameter_bridge-2] [INFO] [1698827487.426446303] [clock_bridge]: Creating GZ->ROS Bridge: [/clock (ignition.msgs.Clock) -> /clock (rosgraph_msgs/msg/Clock)] (Lazy 0)
[robot_state_publisher-3] [WARN] [1698827487.357135972] [kdl_parser]: The root link base_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia.  As a workaround, you can add an extra dummy link to your URDF.
[robot_state_publisher-3] [INFO] [1698827487.357339071] [robot_state_publisher]: got segment base_link
[robot_state_publisher-3] [INFO] [1698827487.357669072] [robot_state_publisher]: got segment bump_front_center
[robot_state_publisher-3] [INFO] [1698827487.357692120] [robot_state_publisher]: got segment bump_front_left
[robot_state_publisher-3] [INFO] [1698827487.357705809] [robot_state_publisher]: got segment bump_front_right
[robot_state_publisher-3] [INFO] [1698827487.357719777] [robot_state_publisher]: got segment bump_left
[robot_state_publisher-3] [INFO] [1698827487.357733466] [robot_state_publisher]: got segment bump_right
[robot_state_publisher-3] [INFO] [1698827487.357746666] [robot_state_publisher]: got segment bumper
[robot_state_publisher-3] [INFO] [1698827487.357760984] [robot_state_publisher]: got segment button_1
[robot_state_publisher-3] [INFO] [1698827487.357774114] [robot_state_publisher]: got segment button_2
[robot_state_publisher-3] [INFO] [1698827487.357787524] [robot_state_publisher]: got segment button_power
[robot_state_publisher-3] [INFO] [1698827487.357801841] [robot_state_publisher]: got segment cliff_front_left
[robot_state_publisher-3] [INFO] [1698827487.357815670] [robot_state_publisher]: got segment cliff_front_right
[robot_state_publisher-3] [INFO] [1698827487.357829568] [robot_state_publisher]: got segment cliff_side_left
[robot_state_publisher-3] [INFO] [1698827487.357842838] [robot_state_publisher]: got segment cliff_side_right
[robot_state_publisher-3] [INFO] [1698827487.357856667] [robot_state_publisher]: got segment front_caster_link
[robot_state_publisher-3] [INFO] [1698827487.357870914] [robot_state_publisher]: got segment front_left_bottom_weight_block
[robot_state_publisher-3] [INFO] [1698827487.357884394] [robot_state_publisher]: got segment front_left_top_weight_block
[robot_state_publisher-3] [INFO] [1698827487.358111938] [robot_state_publisher]: got segment front_left_tower_standoff
[robot_state_publisher-3] [INFO] [1698827487.358126604] [robot_state_publisher]: got segment front_right_bottom_weight_block
[robot_state_publisher-3] [INFO] [1698827487.358140573] [robot_state_publisher]: got segment front_right_top_weight_block
[robot_state_publisher-3] [INFO] [1698827487.358151957] [robot_state_publisher]: got segment front_right_tower_standoff
[robot_state_publisher-3] [INFO] [1698827487.358164877] [robot_state_publisher]: got segment imu_link
[robot_state_publisher-3] [INFO] [1698827487.358177239] [robot_state_publisher]: got segment ir_intensity_front_center_left
[robot_state_publisher-3] [INFO] [1698827487.358189601] [robot_state_publisher]: got segment ir_intensity_front_center_right
[robot_state_publisher-3] [INFO] [1698827487.358202173] [robot_state_publisher]: got segment ir_intensity_front_left
[robot_state_publisher-3] [INFO] [1698827487.358213906] [robot_state_publisher]: got segment ir_intensity_front_right
[robot_state_publisher-3] [INFO] [1698827487.358225849] [robot_state_publisher]: got segment ir_intensity_left
[robot_state_publisher-3] [INFO] [1698827487.358238840] [robot_state_publisher]: got segment ir_intensity_right
[robot_state_publisher-3] [INFO] [1698827487.358250643] [robot_state_publisher]: got segment ir_intensity_side_left
[robot_state_publisher-3] [INFO] [1698827487.358262725] [robot_state_publisher]: got segment ir_omni
[robot_state_publisher-3] [INFO] [1698827487.358274948] [robot_state_publisher]: got segment left_wheel
[robot_state_publisher-3] [INFO] [1698827487.358287240] [robot_state_publisher]: got segment mouse
[robot_state_publisher-3] [INFO] [1698827487.358299672] [robot_state_publisher]: got segment oakd_camera_bracket
[robot_state_publisher-3] [INFO] [1698827487.358312034] [robot_state_publisher]: got segment oakd_imu_frame
[robot_state_publisher-3] [INFO] [1698827487.358324465] [robot_state_publisher]: got segment oakd_left_camera_frame
[robot_state_publisher-3] [INFO] [1698827487.358335989] [robot_state_publisher]: got segment oakd_left_camera_optical_frame
[robot_state_publisher-3] [INFO] [1698827487.358349189] [robot_state_publisher]: got segment oakd_link
[robot_state_publisher-3] [INFO] [1698827487.358362180] [robot_state_publisher]: got segment oakd_rgb_camera_frame
[robot_state_publisher-3] [INFO] [1698827487.358374542] [robot_state_publisher]: got segment oakd_rgb_camera_optical_frame
[robot_state_publisher-3] [INFO] [1698827487.358387393] [robot_state_publisher]: got segment oakd_right_camera_frame
[robot_state_publisher-3] [INFO] [1698827487.358401221] [robot_state_publisher]: got segment oakd_right_camera_optical_frame
[robot_state_publisher-3] [INFO] [1698827487.358412675] [robot_state_publisher]: got segment rear_left_tower_standoff
[robot_state_publisher-3] [INFO] [1698827487.358424688] [robot_state_publisher]: got segment rear_right_tower_standoff
[robot_state_publisher-3] [INFO] [1698827487.358437469] [robot_state_publisher]: got segment right_wheel
[robot_state_publisher-3] [INFO] [1698827487.358449901] [robot_state_publisher]: got segment rplidar_link
[robot_state_publisher-3] [INFO] [1698827487.358495717] [robot_state_publisher]: got segment shell_link
[robot_state_publisher-3] [INFO] [1698827487.358509476] [robot_state_publisher]: got segment tower_sensor_plate
[robot_state_publisher-3] [INFO] [1698827487.358521977] [robot_state_publisher]: got segment wheel_drop_left
[robot_state_publisher-3] [INFO] [1698827487.358548936] [robot_state_publisher]: got segment wheel_drop_right
[robot_state_publisher-5] [WARN] [1698827487.366110122] [kdl_parser]: The root link std_dock_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia.  As a workaround, you can add an extra dummy link to your URDF.
[robot_state_publisher-5] [INFO] [1698827487.366195189] [dock_state_publisher]: got segment green_buoy_link
[robot_state_publisher-5] [INFO] [1698827487.366694835] [dock_state_publisher]: got segment halo_link
[robot_state_publisher-5] [INFO] [1698827487.366715997] [dock_state_publisher]: got segment red_buoy_link
[robot_state_publisher-5] [INFO] [1698827487.366729127] [dock_state_publisher]: got segment std_dock_link
[robot_state_publisher-5] [INFO] [1698827487.366741489] [dock_state_publisher]: got segment yellow_buoy_link
[static_transform_publisher-6] [WARN] [1698827487.333248557] []: Old-style arguments are deprecated; see --help for new-style arguments
[static_transform_publisher-6] [INFO] [1698827487.360680291] [tf_odom_std_dock_link_publisher]: Spinning until stopped - publishing transform
[static_transform_publisher-6] translation: ('0.157000', '0.000000', '0.000000')
[static_transform_publisher-6] rotation: ('0.000000', '0.000000', '1.000000', '0.000000')
[static_transform_publisher-6] from 'odom' to 'std_dock_link'
[create-7] [ros_ign_gazebo] is deprecated! Redirecting to use [ros_gz_sim] instead!
[create-7] 
[create-7] [INFO] [1698827487.413786335] [ros_gz_sim]: Requesting list of world names.
[create-8] [ros_ign_gazebo] is deprecated! Redirecting to use [ros_gz_sim] instead!
[create-8] 
[create-8] [INFO] [1698827487.375442070] [ros_gz_sim]: Requesting list of world names.
[parameter_bridge-9] [INFO] [1698827487.411885598] [cmd_vel_bridge]: Creating GZ->ROS Bridge: [/cmd_vel (ignition.msgs.Twist) -> /cmd_vel (geometry_msgs/msg/Twist)] (Lazy 0)
[parameter_bridge-9] [INFO] [1698827487.426214569] [cmd_vel_bridge]: Creating ROS->GZ Bridge: [/model/turtlebot4/cmd_vel (geometry_msgs/msg/Twist) -> /model/turtlebot4/cmd_vel (ignition.msgs.Twist)] (Lazy 0)
[parameter_bridge-10] [INFO] [1698827487.419858429] [pose_bridge]: Creating GZ->ROS Bridge: [/model/turtlebot4/pose (ignition.msgs.Pose_V) -> /model/turtlebot4/pose (tf2_msgs/msg/TFMessage)] (Lazy 0)
[parameter_bridge-10] [INFO] [1698827487.422707266] [pose_bridge]: Creating GZ->ROS Bridge: [/model/standard_dock/pose (ignition.msgs.Pose_V) -> /model/standard_dock/pose (tf2_msgs/msg/TFMessage)] (Lazy 0)
[parameter_bridge-11] [INFO] [1698827487.404468984] [odom_base_tf_bridge]: Creating GZ->ROS Bridge: [/model/turtlebot4/tf (ignition.msgs.Pose_V) -> /model/turtlebot4/tf (tf2_msgs/msg/TFMessage)] (Lazy 0)
[parameter_bridge-12] [INFO] [1698827487.581853171] [bumper_contact_bridge]: Creating GZ->ROS Bridge: [/bumper_contact (ignition.msgs.Contacts) -> /bumper_contact (ros_gz_interfaces/msg/Contacts)] (Lazy 0)
[parameter_bridge-13] [INFO] [1698827487.402337560] [cliff_front_left_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/base_link/sensor/cliff_front_left/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/base_link/sensor/cliff_front_left/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-14] [INFO] [1698827487.405325800] [cliff_front_right_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/base_link/sensor/cliff_front_right/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/base_link/sensor/cliff_front_right/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-15] [INFO] [1698827487.428964300] [cliff_side_left_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/base_link/sensor/cliff_side_left/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/base_link/sensor/cliff_side_left/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-16] [INFO] [1698827487.511889123] [cliff_side_right_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/base_link/sensor/cliff_side_right/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/base_link/sensor/cliff_side_right/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-17] [INFO] [1698827487.495041526] [ir_intensity_front_center_left_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/ir_intensity_front_center_left/sensor/ir_intensity_front_center_left/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/ir_intensity_front_center_left/sensor/ir_intensity_front_center_left/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-18] [INFO] [1698827487.458423744] [ir_intensity_front_center_right_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/ir_intensity_front_center_right/sensor/ir_intensity_front_center_right/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/ir_intensity_front_center_right/sensor/ir_intensity_front_center_right/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-19] [INFO] [1698827487.603875607] [ir_intensity_front_left_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/ir_intensity_front_left/sensor/ir_intensity_front_left/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/ir_intensity_front_left/sensor/ir_intensity_front_left/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-20] [INFO] [1698827487.538882182] [ir_intensity_front_right_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/ir_intensity_front_right/sensor/ir_intensity_front_right/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/ir_intensity_front_right/sensor/ir_intensity_front_right/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-21] [INFO] [1698827487.534267612] [ir_intensity_left_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/ir_intensity_left/sensor/ir_intensity_left/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/ir_intensity_left/sensor/ir_intensity_left/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-22] [INFO] [1698827487.489735874] [ir_intensity_right_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/ir_intensity_right/sensor/ir_intensity_right/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/ir_intensity_right/sensor/ir_intensity_right/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-23] [INFO] [1698827487.559706906] [ir_intensity_side_left_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/ir_intensity_side_left/sensor/ir_intensity_side_left/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/ir_intensity_side_left/sensor/ir_intensity_side_left/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[parameter_bridge-24] [INFO] [1698827487.703426210] [buttons_msg_bridge]: Creating GZ->ROS Bridge: [/create3_buttons (ignition.msgs.Int32) -> /create3_buttons (std_msgs/msg/Int32)] (Lazy 0)
[parameter_bridge-26] [INFO] [1698827487.537859492] [hmi_buttons_msg_bridge]: Creating GZ->ROS Bridge: [/hmi/buttons (ignition.msgs.Int32) -> /hmi/buttons (std_msgs/msg/Int32)] (Lazy 0)
[parameter_bridge-27] [INFO] [1698827487.632742096] [hmi_led_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/led/power (std_msgs/msg/Int32) -> /hmi/led/power (ignition.msgs.Int32)] (Lazy 0)
[parameter_bridge-27] [INFO] [1698827487.634175524] [hmi_led_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/led/motors (std_msgs/msg/Int32) -> /hmi/led/motors (ignition.msgs.Int32)] (Lazy 0)
[parameter_bridge-27] [INFO] [1698827487.667922540] [hmi_led_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/led/comms (std_msgs/msg/Int32) -> /hmi/led/comms (ignition.msgs.Int32)] (Lazy 0)
[parameter_bridge-27] [INFO] [1698827487.669164113] [hmi_led_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/led/wifi (std_msgs/msg/Int32) -> /hmi/led/wifi (ignition.msgs.Int32)] (Lazy 0)
[parameter_bridge-27] [INFO] [1698827487.670212993] [hmi_led_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/led/battery (std_msgs/msg/Int32) -> /hmi/led/battery (ignition.msgs.Int32)] (Lazy 0)
[parameter_bridge-27] [INFO] [1698827487.706045687] [hmi_led_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/led/user1 (std_msgs/msg/Int32) -> /hmi/led/user1 (ignition.msgs.Int32)] (Lazy 0)
[turtlebot4_node-30] [INFO] [1698827487.711304197] [turtlebot4_node]: Init Turtlebot4 Node Main
[static_transform_publisher-44] [WARN] [1698827487.722332945] []: Old-style arguments are deprecated; see --help for new-style arguments
[rviz2-47] Warning: Ignoring XDG_SESSION_TYPE=wayland on Gnome. Use QT_QPA_PLATFORM=wayland to run on Wayland anyway.
[parameter_bridge-27] [INFO] [1698827487.754507688] [hmi_led_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/led/user2 (std_msgs/msg/Int32) -> /hmi/led/user2 (ignition.msgs.Int32)] (Lazy 0)
[ruby $(which ign) gazebo-1] Warning: Ignoring XDG_SESSION_TYPE=wayland on Gnome. Use QT_QPA_PLATFORM=wayland to run on Wayland anyway.
[parameter_bridge-29] [INFO] [1698827487.772744992] [camera_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/image (ignition.msgs.Image) -> /world/my_world/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/image (sensor_msgs/msg/Image)] (Lazy 0)
[parameter_bridge-29] [INFO] [1698827487.775408889] [camera_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/depth_image (ignition.msgs.Image) -> /world/my_world/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/depth_image (sensor_msgs/msg/Image)] (Lazy 0)
[parameter_bridge-29] [INFO] [1698827487.776910412] [camera_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/points (ignition.msgs.PointCloudPacked) -> /world/my_world/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/points (sensor_msgs/msg/PointCloud2)] (Lazy 0)
[ir_intensity_vector_publisher-34] [INFO] [1698827487.780053631] [ir_intensity_vector_publisher]: Advertised topic: ir_intensity
[ir_intensity_vector_publisher-34] [INFO] [1698827487.784420962] [ir_intensity_vector_publisher]: Subscription to topic: _internal/ir_intensity_front_center_left
[robot_state-38] [INFO] [1698827487.787966259] [robot_state]: Advertised topic: battery_state
[robot_state-38] [INFO] [1698827487.789565840] [robot_state]: Subscription to topic: dock_status
[robot_state-38] [INFO] [1698827487.790037130] [robot_state]: Advertised topic: stop_status
[robot_state-38] [INFO] [1698827487.792655979] [robot_state]: Subscription to topic: odom
[parameter_bridge-29] [INFO] [1698827487.788077586] [camera_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/camera_info (ignition.msgs.CameraInfo) -> /world/my_world/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/camera_info (sensor_msgs/msg/CameraInfo)] (Lazy 0)
[hazards_vector_publisher-33] [INFO] [1698827487.807667651] [hazards_vector_publisher]: Advertised topic: hazard_detection
[hazards_vector_publisher-33] [INFO] [1698827487.809854669] [hazards_vector_publisher]: Subscription to topic: _internal/bumper/event
[ir_intensity_vector_publisher-34] [INFO] [1698827487.810195147] [ir_intensity_vector_publisher]: Subscription to topic: _internal/ir_intensity_front_center_right
[ir_intensity_vector_publisher-34] [INFO] [1698827487.810731111] [ir_intensity_vector_publisher]: Subscription to topic: _internal/ir_intensity_front_left
[ir_intensity_vector_publisher-34] [INFO] [1698827487.811153862] [ir_intensity_vector_publisher]: Subscription to topic: _internal/ir_intensity_front_right
[ir_intensity_vector_publisher-34] [INFO] [1698827487.811679000] [ir_intensity_vector_publisher]: Subscription to topic: _internal/ir_intensity_left
[ir_intensity_vector_publisher-34] [INFO] [1698827487.812063478] [ir_intensity_vector_publisher]: Subscription to topic: _internal/ir_intensity_right
[wheel_status_publisher-36] [INFO] [1698827487.810074111] [wheel_status_publisher]: Advertised topic: wheel_vels
[ir_intensity_vector_publisher-34] [INFO] [1698827487.812445441] [ir_intensity_vector_publisher]: Subscription to topic: _internal/ir_intensity_side_left
[mock_publisher-37] [INFO] [1698827487.814868384] [mock_publisher]: Advertised mocked topic: slip_status
[hazards_vector_publisher-33] [INFO] [1698827487.832427876] [hazards_vector_publisher]: Subscription to topic: _internal/cliff_front_left/event
[parameter_bridge-25] [INFO] [1698827487.834060143] [hmi_display_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/display/raw (std_msgs/msg/String) -> /hmi/display/raw (ignition.msgs.StringMsg)] (Lazy 0)
[hazards_vector_publisher-33] [INFO] [1698827487.838086717] [hazards_vector_publisher]: Subscription to topic: _internal/cliff_front_right/event
[hazards_vector_publisher-33] [INFO] [1698827487.838590554] [hazards_vector_publisher]: Subscription to topic: _internal/cliff_side_left/event
[hazards_vector_publisher-33] [INFO] [1698827487.838983203] [hazards_vector_publisher]: Subscription to topic: _internal/cliff_side_right/event
[hazards_vector_publisher-33] [INFO] [1698827487.839446602] [hazards_vector_publisher]: Subscription to topic: _internal/wheel_drop/left_wheel/event
[hazards_vector_publisher-33] [INFO] [1698827487.839896731] [hazards_vector_publisher]: Subscription to topic: _internal/wheel_drop/right_wheel/event
[hazards_vector_publisher-33] [INFO] [1698827487.840318434] [hazards_vector_publisher]: Subscription to topic: _internal/backup_limit
[static_transform_publisher-45] [WARN] [1698827487.852440691] []: Old-style arguments are deprecated; see --help for new-style arguments
[wheel_status_publisher-36] [INFO] [1698827487.864729172] [wheel_status_publisher]: Advertised topic: wheel_ticks
[parameter_bridge-25] [INFO] [1698827487.868935588] [hmi_display_msg_bridge]: Creating ROS->GZ Bridge: [/hmi/display/selected (std_msgs/msg/Int32) -> /hmi/display/selected (ignition.msgs.Int32)] (Lazy 0)
[parameter_bridge-28] [INFO] [1698827487.873043040] [lidar_bridge]: Creating GZ->ROS Bridge: [/world/my_world/model/turtlebot4/link/rplidar_link/sensor/rplidar/scan (ignition.msgs.LaserScan) -> /world/my_world/model/turtlebot4/link/rplidar_link/sensor/rplidar/scan (sensor_msgs/msg/LaserScan)] (Lazy 0)
[static_transform_publisher-45] [INFO] [1698827488.002331265] [camera_stf]: Spinning until stopped - publishing transform
[static_transform_publisher-45] translation: ('0.000000', '0.000000', '0.000000')
[static_transform_publisher-45] rotation: ('0.499952', '-0.500000', '0.500000', '0.500048')
[static_transform_publisher-45] from 'oakd_rgb_camera_optical_frame' to 'turtlebot4/oakd_rgb_camera_frame/rgbd_camera'
[motion_control-35] [INFO] [1698827488.072121547] [motion_control]: Enabling REFLEX_BUMP
[motion_control-35] [INFO] [1698827488.072323459] [motion_control]: Enabling REFLEX_CLIFF
[motion_control-35] [INFO] [1698827488.072606946] [motion_control]: Enabling REFLEX_STUCK
[motion_control-35] [INFO] [1698827488.072735315] [motion_control]: Enabling REFLEX_WHEEL_DROP
[ui_mgr-40] [INFO] [1698827488.083681231] [ui_mgr]: Subscription to topic: cmd_lightring
[kidnap_estimator_publisher-39] [INFO] [1698827488.085244215] [kidnap_estimator_publisher]: Advertised topic: kidnap_status
[kidnap_estimator_publisher-39] [INFO] [1698827488.094316911] [kidnap_estimator_publisher]: Subscription to topic: hazard_detection
[ui_mgr-40] [INFO] [1698827488.096196417] [ui_mgr]: Subscription to topic: cmd_audio
[static_transform_publisher-44] [INFO] [1698827488.111074342] [rplidar_stf]: Spinning until stopped - publishing transform
[static_transform_publisher-44] translation: ('0.000000', '0.000000', '0.000000')
[static_transform_publisher-44] rotation: ('0.000000', '0.000000', '0.000000', '1.000000')
[static_transform_publisher-44] from 'rplidar_link' to 'turtlebot4/rplidar_link/rplidar'
[sync_slam_toolbox_node-46] [INFO] [1698827488.207244614] [slam_toolbox]: Node using stack size 40000000
[joint_state_publisher-4] [INFO] [1698827488.476319926] [joint_state_publisher]: Waiting for robot_description to be published on the robot_description topic...
[create-7] [INFO] [1698827488.576583262] [ros_gz_sim]: Waiting messages on topic [robot_description].
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:/qml/StyleDialog.qml:112:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:/qml/StyleDialog.qml:105:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:/qml/StyleDialog.qml:98:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:102:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:/qml/PluginMenu.qml:27:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[turtlebot4_node-30] [INFO] [1698827488.616135088] [turtlebot4_node]: Buttons Init
[turtlebot4_node-30] [INFO] [1698827488.619560257] [turtlebot4_node]: Init Display
[turtlebot4_node-30] [INFO] [1698827488.621300149] [turtlebot4_node]: Leds Init
[turtlebot4_node-30] [INFO] [1698827488.629318587] [turtlebot4_node]: Turtlebot4 standard running.
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/Gazebo/GazeboDrawer.qml:242:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [Dbg] [gz.cc:161] Subscribing to [/gazebo/starting_world].
[ruby $(which ign) gazebo-1] [Dbg] [gz.cc:163] Waiting for a world to be set from the GUI...
[ruby $(which ign) gazebo-1] [Msg] Received world [my_world.sdf] from the GUI.
[ruby $(which ign) gazebo-1] [Dbg] [gz.cc:167] Unsubscribing from [/gazebo/starting_world].
[ruby $(which ign) gazebo-1] [Msg] Ignition Gazebo Server v6.15.0
[ruby $(which ign) gazebo-1] [Msg] Loading SDF world file[/home/shananda/turtlebot4_ws/install/turtlebot4_ignition_bringup/share/turtlebot4_ignition_bringup/worlds/my_world.sdf].
[ruby $(which ign) gazebo-1] [Msg] Serving entity system service on [/entity/system/add]
[ruby $(which ign) gazebo-1] [Msg] Loaded level [3]
[ruby $(which ign) gazebo-1] [Msg] No systems loaded from SDF, loading defaults
[ruby $(which ign) gazebo-1] [Dbg] [ServerConfig.cc:1027] Loaded (3) plugins from file [/home/shananda/.ignition/gazebo/6/server.config]
[ruby $(which ign) gazebo-1] [Dbg] [Physics.cc:804] Loaded [ignition::physics::dartsim::Plugin] from library [/usr/lib/x86_64-linux-gnu/ign-physics-5/engine-plugins/libignition-physics-dartsim-plugin.so]
[ruby $(which ign) gazebo-1] [Dbg] [SystemManager.cc:70] Loaded system [gz::sim::systems::Physics] for entity [1]
[ruby $(which ign) gazebo-1] [Msg] Create service on [/world/warehouse/create]
[ruby $(which ign) gazebo-1] [Msg] Remove service on [/world/warehouse/remove]
[ruby $(which ign) gazebo-1] [Msg] Pose service on [/world/warehouse/set_pose]
[ruby $(which ign) gazebo-1] [Msg] Pose service on [/world/warehouse/set_pose_vector]
[ruby $(which ign) gazebo-1] [Msg] Light configuration service on [/world/warehouse/light_config]
[ruby $(which ign) gazebo-1] [Msg] Physics service on [/world/warehouse/set_physics]
[ruby $(which ign) gazebo-1] [Msg] SphericalCoordinates service on [/world/warehouse/set_spherical_coordinates]
[ruby $(which ign) gazebo-1] [Msg] Enable collision service on [/world/warehouse/enable_collision]
[ruby $(which ign) gazebo-1] [Msg] Disable collision service on [/world/warehouse/disable_collision]
[ruby $(which ign) gazebo-1] [Msg] Material service on [/world/warehouse/visual_config]
[ruby $(which ign) gazebo-1] [Msg] Material service on [/world/warehouse/wheel_slip]
[ruby $(which ign) gazebo-1] [Dbg] [SystemManager.cc:70] Loaded system [gz::sim::systems::UserCommands] for entity [1]
[ruby $(which ign) gazebo-1] [Dbg] [SystemManager.cc:70] Loaded system [gz::sim::systems::SceneBroadcaster] for entity [1]
[ruby $(which ign) gazebo-1] [Msg] Serving world controls on [/world/warehouse/control], [/world/warehouse/control/state] and [/world/warehouse/playback/control]
[ruby $(which ign) gazebo-1] [Msg] Serving GUI information on [/world/warehouse/gui/info]
[ruby $(which ign) gazebo-1] [Msg] World [warehouse] initialized with [default_physics] physics profile.
[ruby $(which ign) gazebo-1] [Msg] Serving world SDF generation service on [/world/warehouse/generate_world_sdf]
[ruby $(which ign) gazebo-1] [Msg] Serving world names on [/gazebo/worlds]
[create-8] [INFO] [1698827488.676977620] [ros_gz_sim]: Waiting messages on topic [standard_dock_description].
[rviz2-47] [INFO] [1698827488.703368785] [rviz2]: Stereo is NOT SUPPORTED
[rviz2-47] [INFO] [1698827488.703787275] [rviz2]: OpenGl version: 4.6 (GLSL 4.6)
[rviz2-47] [INFO] [1698827488.890641277] [rviz2]: Stereo is NOT SUPPORTED
[create-7] [INFO] [1698827488.902255019] [ros_gz_sim]: Requested creation of entity.
[create-7] [INFO] [1698827488.902312219] [ros_gz_sim]: OK creation of entity.
[create-8] [INFO] [1698827489.053388981] [ros_gz_sim]: Requested creation of entity.
[create-8] [INFO] [1698827489.054981298] [ros_gz_sim]: OK creation of entity.
[INFO] [create-7]: process has finished cleanly [pid 19232]
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Scene3D.cc:2941] The GzScene3D plugin is deprecated on v6 and will be removed on v7. Use MinimalScene together with other plugins as needed.
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/GzScene3D/GzScene3D.qml:108:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/GzScene3D/GzScene3D.qml:63:5: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/WorldControl/WorldControl.qml:30:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[parameter_bridge-27] [INFO] [1698827489.382494358] [hmi_led_msg_bridge]: Passing message from ROS std_msgs/msg/Int32 to Gazebo gz.msgs.Int32 (showing msg only once per type)
[ruby $(which ign) gazebo-1] [Msg] Resource path add service on [/gazebo/resource_paths/add[1;3[Msg] Ignition Gazebo GUI    v6.15.0
[ruby $(which ign) gazebo-1] [Dbg] [Gui.cc:253] Waiting for subscribers to [/gazebo/starting_world]...
[ruby $(which ign) gazebo-1] [Dbg] [Application.cc:92] Initializing application.
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:555] Create main window
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [PathManager.cc:66] Requesting resource paths through [/gazebo/resource_paths/get]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Gui.cc:333] GUI requesting list of world names. The server may be busy downloading resources. Please be patient.
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [PathManager.cc:55] Received resource paths.
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [GuiRunner.cc:145] Requesting initial state from [/world/warehouse/state]...
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loading config [/home/shananda/turtlebot4_ws/install/turtlebot4_ignition_bringup/share/turtlebot4_ignition_bringup/gui/standard/gui.config]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:426] Loading plugin [GzScene3D]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Video recorder stats topic advertised on [/gui/record_video/stats]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Transform mode service on [/gui/transform_mode]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Record video service on [/gui/record_video]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Move to service on [/gui/move_to]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Follow service on [/gui/follow]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Follow offset service on [/gui/follow/offset]
[ruby $(which ign) gazebo-1] [GUI] [Msg] View angle service on [/gui/view_angle]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Move to pose service on [/gui/move_to/pose]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Camera pose topic advertised on [/gui/camera/pose]
[ruby $(which ign) gazebo-1] [GUI] [Msg] View as transparent service on [/gui/view/transparent]
[ruby $(which ign) gazebo-1] [GUI] [Msg] View center of mass service on [/gui/view/com]
[ruby $(which ign) gazebo-1] [GUI] [Msg] View inertia service on [/gui/view/inertia]
[ruby $(which ign) gazebo-1] [GUI] [Msg] View joints service on [/gui/view/joints]
[ruby $(which ign) gazebo-1] [GUI] [Msg] View wireframes service on [/gui/view/wireframes]
[ruby $(which ign) gazebo-1] [GUI] [Msg] View collisions service on [/gui/view/collisions]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Camera view controller topic advertised on [/gui/camera/view_control]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Added plugin [3D View] to main window
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loaded plugin [GzScene3D] from path [/usr/lib/x86_64-linux-gnu/ign-gazebo-6/plugins/gui/libGzScene3D.so]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:426] Loading plugin [WorldControl]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Using world control service [/world/warehouse/control]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Listening to stats on [/world/warehouse/stats]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [WorldControl.cc:248] Using a service to share WorldControl msgs with the server
[INFO] [create-8]: process has finished cleanly [pid 19234]
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/TransformControl/TransformControl.qml:104:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/TransformControl/TransformControl.qml:99:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/TransformControl/TransformControl.qml:94:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/TransformControl/TransformControl.qml:89:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[sync_slam_toolbox_node-46] [INFO] [1698827489.546762442] [slam_toolbox]: Using solver plugin solver_plugins::CeresSolver
[sync_slam_toolbox_node-46] [INFO] [1698827489.564177571] [slam_toolbox]: CeresSolver: Using SCHUR_JACOBI preconditioner.
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/Turtlebot4Hmi/Turtlebot4Hmi.qml:36:3: QML Connections: Implicitly defined onFoo properties in Connections are deprecated. Use this syntax instead: function onFoo(<arguments>) { ... }
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/Turtlebot4Hmi/Turtlebot4Hmi.qml:388: ReferenceError: control is not defined
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/Turtlebot4Hmi/Turtlebot4Hmi.qml:410: ReferenceError: control is not defined
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/Turtlebot4Hmi/Turtlebot4Hmi.qml:432: ReferenceError: control is not defined
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/Turtlebot4Hmi/Turtlebot4Hmi.qml:454: ReferenceError: control is not defined
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/Turtlebot4Hmi/Turtlebot4Hmi.qml:102:7: Unable to assign [undefined] to QString
[parameter_bridge-25] [INFO] [1698827489.680520107] [hmi_display_msg_bridge]: Passing message from ROS std_msgs/msg/String to Gazebo gz.msgs.StringMsg (showing msg only once per type)
[parameter_bridge-25] [INFO] [1698827489.680657835] [hmi_display_msg_bridge]: Passing message from ROS std_msgs/msg/Int32 to Gazebo gz.msgs.Int32 (showing msg only once per type)
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::/WorldStats/WorldStats.qml:53:3: QML RowLayout: Binding loop detected for property "x"
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Ogre2Camera.cc:390] Ogre2Camera::SetVisibilityMask: Mask bits c0000000 are set but will be ignored as they conflict with the reserved bits used internally by the ogre2 backend.
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953135477] [gz_ros2_control]: [ign_ros2_control] Fixed joint [bumper_joint] (Entity=157)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953310220] [gz_ros2_control]: [ign_ros2_control] Fixed joint [front_caster_joint] (Entity=158)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953330684] [gz_ros2_control]: [ign_ros2_control] Fixed joint [front_left_bottom_weight_block_joint] (Entity=159)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953347516] [gz_ros2_control]: [ign_ros2_control] Fixed joint [front_left_top_weight_block_joint] (Entity=160)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953362113] [gz_ros2_control]: [ign_ros2_control] Fixed joint [front_right_bottom_weight_block_joint] (Entity=161)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953376640] [gz_ros2_control]: [ign_ros2_control] Fixed joint [front_right_top_weight_block_joint] (Entity=162)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953389351] [gz_ros2_control]: [ign_ros2_control] Fixed joint [imu_joint] (Entity=163)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953404018] [gz_ros2_control]: [ign_ros2_control] Fixed joint [ir_intensity_front_center_left_joint] (Entity=164)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953418265] [gz_ros2_control]: [ign_ros2_control] Fixed joint [ir_intensity_front_center_right_joint] (Entity=165)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953432373] [gz_ros2_control]: [ign_ros2_control] Fixed joint [ir_intensity_front_left_joint] (Entity=166)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953446272] [gz_ros2_control]: [ign_ros2_control] Fixed joint [ir_intensity_front_right_joint] (Entity=167)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953460519] [gz_ros2_control]: [ign_ros2_control] Fixed joint [ir_intensity_left_joint] (Entity=168)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953474418] [gz_ros2_control]: [ign_ros2_control] Fixed joint [ir_intensity_right_joint] (Entity=169)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953488247] [gz_ros2_control]: [ign_ros2_control] Fixed joint [ir_intensity_side_left_joint] (Entity=170)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953501586] [gz_ros2_control]: [ign_ros2_control] Fixed joint [ir_omni_joint] (Entity=171)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953515904] [gz_ros2_control]: [ign_ros2_control] Fixed joint [mouse_joint] (Entity=172)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953529174] [gz_ros2_control]: [ign_ros2_control] Fixed joint [front_left_tower_standoff_joint] (Entity=173)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953541745] [gz_ros2_control]: [ign_ros2_control] Fixed joint [front_right_tower_standoff_joint] (Entity=174)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953555434] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_camera_bracket_joint] (Entity=175)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953567936] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_joint] (Entity=176)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953580717] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_imu_joint] (Entity=177)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953594057] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_left_camera_joint] (Entity=178)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953608444] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_left_camera_optical_joint] (Entity=179)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953622203] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_rgb_camera_joint] (Entity=180)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953636660] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_rgb_camera_optical_joint] (Entity=181)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953650768] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_right_camera_joint] (Entity=182)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953664527] [gz_ros2_control]: [ign_ros2_control] Fixed joint [oakd_right_camera_optical_joint] (Entity=183)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953679612] [gz_ros2_control]: [ign_ros2_control] Fixed joint [rear_left_tower_standoff_joint] (Entity=184)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953694768] [gz_ros2_control]: [ign_ros2_control] Fixed joint [rear_right_tower_standoff_joint] (Entity=185)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953708736] [gz_ros2_control]: [ign_ros2_control] Fixed joint [rplidar_joint] (Entity=186)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.953723403] [gz_ros2_control]: [ign_ros2_control] Fixed joint [tower_sensor_plate_joint] (Entity=187)] is skipped
[ruby $(which ign) gazebo-1] [INFO] [1698827489.958281612] [gz_ros2_control]: connected to service!! robot_state_publisher asking for robot_description
[ruby $(which ign) gazebo-1] [INFO] [1698827490.948973603] [gz_ros2_control]: Received URDF from param server
[ruby $(which ign) gazebo-1] [WARN] [1698827490.953632873] [gz_ros2_control]: The position_proportional_gain parameter was not defined, defaulting to: 0.1
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953688117] [gz_ros2_control]: Loading joint: left_wheel_joint
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953701946] [gz_ros2_control]:   State:
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953713679] [gz_ros2_control]:        velocity
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953725971] [gz_ros2_control]:        position
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953737006] [gz_ros2_control]:   Command:
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953746994] [gz_ros2_control]:        velocity
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953848054] [gz_ros2_control]: Loading sensor: imu
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953865794] [gz_ros2_control]:   State:
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953896804] [resource_manager]: Initialize hardware 'left_wheel_controller' 
[ruby $(which ign) gazebo-1] [WARN] [1698827490.953916220] [gz_ros2_control]: On init...
[ruby $(which ign) gazebo-1] [INFO] [1698827490.953972931] [resource_manager]: Successful initialization of hardware 'left_wheel_controller'
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954003452] [resource_manager]: 'configure' hardware 'left_wheel_controller' 
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954010506] [gz_ros2_control]: System Successfully configured!
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954029712] [resource_manager]: Successful 'configure' of hardware 'left_wheel_controller'
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954038233] [resource_manager]: 'activate' hardware 'left_wheel_controller' 
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954046265] [resource_manager]: Successful 'activate' of hardware 'left_wheel_controller'
[ruby $(which ign) gazebo-1] [WARN] [1698827490.954078741] [gz_ros2_control]: The position_proportional_gain parameter was not defined, defaulting to: 0.1
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954103535] [gz_ros2_control]: Loading joint: right_wheel_joint
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954117433] [gz_ros2_control]:   State:
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954130703] [gz_ros2_control]:        velocity
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954145021] [gz_ros2_control]:        position
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954156545] [gz_ros2_control]:   Command:
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954167440] [gz_ros2_control]:        velocity
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954184761] [gz_ros2_control]: Loading sensor: imu
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954197891] [gz_ros2_control]:   State:
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954211440] [resource_manager]: Initialize hardware 'right_wheel_controller' 
[ruby $(which ign) gazebo-1] [WARN] [1698827490.954218075] [gz_ros2_control]: On init...
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954246989] [resource_manager]: Successful initialization of hardware 'right_wheel_controller'
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954256907] [resource_manager]: 'configure' hardware 'right_wheel_controller' 
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954262005] [gz_ros2_control]: System Successfully configured!
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954275834] [resource_manager]: Successful 'configure' of hardware 'right_wheel_controller'
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954282539] [resource_manager]: 'activate' hardware 'right_wheel_controller' 
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954288685] [resource_manager]: Successful 'activate' of hardware 'right_wheel_controller'
[ruby $(which ign) gazebo-1] [INFO] [1698827490.954293923] [gz_ros2_control]: Loading controller_manager
[spawner-32] [INFO] [1698827491.076768407] [spawner_joint_state_broadcaster]: Waiting for '/controller_manager' node to exist
[ruby $(which ign) gazebo-1] [Wrn] [Model.hh:69] Skipping serialization / deserialization for models with //pose/@relative_to attribute.
[ruby $(which ign) gazebo-1] [Wrn] [Component.hh:144] Trying to serialize component with data type [N3sdf3v125WorldE], which doesn't have `operator<<`. Component will not be serialized.
[ruby $(which ign) gazebo-1] [Wrn] [Component.hh:127] Trying to serialize component with data type [St10shared_ptrIN3sdf3v127ElementEE], which doesn't have `operator<<`. Component will not be serialized.
[ruby $(which ign) gazebo-1] ].
[ruby $(which ign) gazebo-1] [Msg] Resource path get service on [/gazebo/resource_paths/get].
[ruby $(which ign) gazebo-1] [Msg] Resource path resolve service on [/gazebo/resource_paths/resolve].
[ruby $(which ign) gazebo-1] [Msg] Resource paths published on [/gazebo/resource_paths].
[ruby $(which ign) gazebo-1] [Msg] Server control service on [/server_control].
[ruby $(which ign) gazebo-1] [Msg] Found no publishers on /stats, adding root stats topic
[ruby $(which ign) gazebo-1] [Msg] Found no publishers on /clock, adding root clock topic
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:496] Creating PostUpdate worker threads: 2
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:507] Creating postupdate worker thread (0)
[ruby $(which ign) gazebo-1] [Dbg] [SystemManager.cc:70] Loaded system [ign_ros2_control::IgnitionROS2ControlPlugin] for entity [74]
[ruby $(which ign) gazebo-1] [Dbg] [SystemManager.cc:70] Loaded system [ignition::gazebo::systems::PosePublisher] for entity [74]
[ruby $(which ign) gazebo-1] [Dbg] [SystemManager.cc:70] Loaded system [ignition::gazebo::systems::Contact] for entity [74]
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:490] Configuring Sensors system
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:415] SensorsPrivate::Run
[ruby $(which ign) gazebo-1] [Dbg] [SystemManager.cc:70] Loaded system [ignition::gazebo::systems::Sensors] for entity [74]
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:395] SensorsPrivate::RenderThread started
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:246] Waiting for init
[ruby $(which ign) gazebo-1] [Dbg] [UserCommands.cc:1303] Created entity [74] named [turtlebot4]
[ruby $(which ign) gazebo-1] [Dbg] [SystemManager.cc:70] Loaded system [ignition::gazebo::systems::PosePublisher] for entity [192]
[ruby $(which ign) gazebo-1] [Dbg] [UserCommands.cc:1303] Created entity [192] named [standard_dock]
[ruby $(which ign) gazebo-1] [Msg] Serving scene information on [/world/warehouse/scene/info]
[ruby $(which ign) gazebo-1] [Msg] Serving graph information on [/world/warehouse/scene/graph]
[ruby $(which ign) gazebo-1] [Msg] Serving full state on [/world/warehouse/state]
[ruby $(which ign) gazebo-1] [Msg] Serving full state (async) on [/world/warehouse/state_async]
[ruby $(which ign) gazebo-1] [Msg] Publishing scene information on [/world/warehouse/scene/info]
[ruby $(which ign) gazebo-1] [Msg] Publishing entity deletions on [/world/warehouse/scene/deletion]
[ruby $(which ign) gazebo-1] [Msg] Publishing state changes on [/world/warehouse/state]
[ruby $(which ign) gazebo-1] [Msg] Publishing pose messages on [/world/warehouse/pose/info]
[ruby $(which ign) gazebo-1] [Msg] Publishing dynamic pose messages on [/world/warehouse/dynamic_pose/info]
[ruby $(which ign) gazebo-1] [Dbg] [EntityComponentManager.cc:1623] Updated state thread iterators: 16 threads processing around 13 entities each.
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:523] Exiting postupdate worker thread (0)
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:496] Creating PostUpdate worker threads: 7
[ruby $(which ign) gazebo-1] [WARN] [1698827491.310790945] [gz_ros2_control]:  Desired controller update period (0.001 s) is slower than the gazebo simulation period (0 s).
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Component.hh:189] Trying to deserialize component with data type [N3sdf3v125WorldE], which doesn't have `operator>>`. Component will not be deserialized.
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [Err] [SystemPaths.cc:473] Could not resolve file [cardboard_box.png]
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Component.hh:172] Trying to deserialize component with data type [St10shared_ptrIN3sdf3v127ElementEE], which doesn't have `operator>>`. Component will not be deserialized.
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [INFO] [1698827492.500303170] [controller_manager]: Loading controller 'joint_state_broadcaster'
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [INFO] [1698827492.536376957] [controller_manager]: Setting use_sim_time=True for joint_state_broadcaster to match controller manager (see ros2_control#325 for details)
[spawner-32] [INFO] [1698827492.538680331] [spawner_joint_state_broadcaster]: Loaded joint_state_broadcaster
[ruby $(which ign) gazebo-1] [INFO] [1698827492.542386333] [controller_manager]: Configuring controller 'joint_state_broadcaster'
[ruby $(which ign) gazebo-1] [INFO] [1698827492.542585312] [joint_state_broadcaster]: 'joints' or 'interfaces' parameter is empty. All available state interfaces will be published
[ruby $(which ign) gazebo-1] [Wrn] [ColladaLoader.cc:2394] Triangle input semantic: 'COLOR' is currently not supported
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [Wrn] [ColladaLoader.cc:2394] Triangle input semantic: 'COLOR' is currently not supported
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:507] Creating postupdate worker thread (0)
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:507] Creating postupdate worker thread (1)
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:507] Creating postupdate worker thread (2)
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:507] Creating postupdate worker thread (3)
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:507] Creating postupdate worker thread (4)
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:507] Creating postupdate worker thread (5)
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:594] Initialization needed
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:258] Initializing render context
[ruby $(which ign) gazebo-1] [Msg] Loading plugin [ignition-rendering-ogre2]
[ruby $(which ign) gazebo-1] [Dbg] [RenderUtil.cc:2588] Create scene [scene]
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:272] Rendering Thread initialized
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:594] Initialization needed
[ruby $(which ign) gazebo-1] [Dbg] [RgbdCameraSensor.cc:216] RGB images for [turtlebot4::oakd_rgb_camera_frame::rgbd_camera] advertised on [world/warehouse/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/image]
[ruby $(which ign) gazebo-1] [Dbg] [RgbdCameraSensor.cc:230] Depth images for [turtlebot4::oakd_rgb_camera_frame::rgbd_camera] advertised on [world/warehouse/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/depth_image]
[ruby $(which ign) gazebo-1] [Dbg] [RgbdCameraSensor.cc:244] Points for [turtlebot4::oakd_rgb_camera_frame::rgbd_camera] advertised on [world/warehouse/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/points]
[ruby $(which ign) gazebo-1] [Dbg] [CameraSensor.cc:619] Camera info for [turtlebot4::oakd_rgb_camera_frame::rgbd_camera] advertised on [world/warehouse/model/turtlebot4/link/oakd_rgb_camera_frame/sensor/rgbd_camera/camera_info]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::base_link::cliff_front_left] advertised on [world/warehouse/model/turtlebot4/link/base_link/sensor/cliff_front_left/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::base_link::cliff_front_left] advertised on [world/warehouse/model/turtlebot4/link/base_link/sensor/cliff_front_left/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::base_link::cliff_front_right] advertised on [world/warehouse/model/turtlebot4/link/base_link/sensor/cliff_front_right/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::base_link::cliff_front_right] advertised on [world/warehouse/model/turtlebot4/link/base_link/sensor/cliff_front_right/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::base_link::cliff_side_left] advertised on [world/warehouse/model/turtlebot4/link/base_link/sensor/cliff_side_left/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::base_link::cliff_side_left] advertised on [world/warehouse/model/turtlebot4/link/base_link/sensor/cliff_side_left/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::base_link::cliff_side_right] advertised on [world/warehouse/model/turtlebot4/link/base_link/sensor/cliff_side_right/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::base_link::cliff_side_right] advertised on [world/warehouse/model/turtlebot4/link/base_link/sensor/cliff_side_right/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::ir_intensity_front_center_left::ir_intensity_front_center_left] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_center_left/sensor/ir_intensity_front_center_left/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::ir_intensity_front_center_left::ir_intensity_front_center_left] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_center_left/sensor/ir_intensity_front_center_left/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::ir_intensity_front_center_right::ir_intensity_front_center_right] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_center_right/sensor/ir_intensity_front_center_right/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::ir_intensity_front_center_right::ir_intensity_front_center_right] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_center_right/sensor/ir_intensity_front_center_right/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::ir_intensity_front_left::ir_intensity_front_left] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_left/sensor/ir_intensity_front_left/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::ir_intensity_front_left::ir_intensity_front_left] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_left/sensor/ir_intensity_front_left/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::ir_intensity_front_right::ir_intensity_front_right] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_right/sensor/ir_intensity_front_right/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::ir_intensity_front_right::ir_intensity_front_right] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_right/sensor/ir_intensity_front_right/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::ir_intensity_left::ir_intensity_left] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_left/sensor/ir_intensity_left/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::ir_intensity_left::ir_intensity_left] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_left/sensor/ir_intensity_left/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::ir_intensity_right::ir_intensity_right] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_right/sensor/ir_intensity_right/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::ir_intensity_right::ir_intensity_right] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_right/sensor/ir_intensity_right/scan/points]
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Model.hh:98] Unable to deserialize sdf::Model
[ruby $(which ign) gazebo-1] [GUI] [Err] [SystemPaths.cc:473] Could not resolve file [cardboard_box.png]
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [ColladaLoader.cc:2394] Triangle input semantic: 'COLOR' is currently not supported
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [ColladaLoader.cc:2394] Triangle input semantic: 'COLOR' is currently not supported
[spawner-32] [INFO] [1698827521.061777494] [spawner_joint_state_broadcaster]: Configured and activated joint_state_broadcaster
[parameter_bridge-9] [INFO] [1698827521.084444079] [cmd_vel_bridge]: Passing message from ROS geometry_msgs/msg/Twist to Gazebo gz.msgs.Twist (showing msg only once per type)
[turtlebot4_node-30] [INFO] [1698827521.113455419] [turtlebot4_node]: OAKD stopped
[turtlebot4_node-30] [INFO] [1698827521.113511222] [turtlebot4_node]: RPLIDAR stopped
[INFO] [spawner-32]: process has finished cleanly [pid 19600]
[INFO] [spawner-48]: process started with pid [20342]
[turtlebot4_node-30] [INFO] [1698827523.949743086] [turtlebot4_node]: Undocking
[turtlebot4_node-30] [INFO] [1698827523.949807480] [turtlebot4_node]: Waiting for undock action server
[spawner-48] [INFO] [1698827524.116808115] [spawner_diffdrive_controller]: Waiting for '/controller_manager' node to exist
[ruby $(which ign) gazebo-1] [INFO] [1698827524.737462555] [controller_manager]: Loading controller 'diffdrive_controller'
[ruby $(which ign) gazebo-1] [INFO] [1698827524.807458591] [controller_manager]: Setting use_sim_time=True for diffdrive_controller to match controller manager (see ros2_control#325 for details)
[spawner-48] [INFO] [1698827524.809642745] [spawner_diffdrive_controller]: Loaded diffdrive_controller
[ruby $(which ign) gazebo-1] [INFO] [1698827524.813081114] [controller_manager]: Configuring controller 'diffdrive_controller'
[ruby $(which ign) gazebo-1] [INFO] [1698827524.813274017] [diffdrive_controller]: Parameters were updated
[ruby $(which ign) gazebo-1] [WARN] [1698827524.826305681] [diffdrive_controller]: Can't accept new commands. subscriber is inactive
[spawner-48] [INFO] [1698827524.836291276] [spawner_diffdrive_controller]: Configured and activated diffdrive_controller
[turtlebot4_node-30] [INFO] [1698827524.950147942] [turtlebot4_node]: undock action server available, sending goal
[motion_control-35] [INFO] [1698827524.950436876] [motion_control]: Received new undock goal
[turtlebot4_node-30] [INFO] [1698827524.950669030] [turtlebot4_node]: undock goal accepted by server, waiting for result
[INFO] [spawner-48]: process has finished cleanly [pid 20342]
[turtlebot4_node-30] [INFO] [1698827525.197893645] [turtlebot4_node]: OAKD started
[turtlebot4_node-30] [INFO] [1698827525.197957620] [turtlebot4_node]: RPLIDAR started
[motion_control-35] [INFO] [1698827534.639493845] [motion_control]: Undock Goal Succeeded
[turtlebot4_node-30] [INFO] [1698827534.639924069] [turtlebot4_node]: undock goal succeeded
[turtlebot4_node-30] [ERROR] [1698827551.123877470] [turtlebot4_node]: Service oakd/stop_camera unavailable.
[turtlebot4_node-30] [ERROR] [1698827551.134112259] [turtlebot4_node]: Service stop_motor unavailable.
[turtlebot4_node-30] [ERROR] [1698827555.208419620] [turtlebot4_node]: Service oakd/start_camera unavailable.
[turtlebot4_node-30] [ERROR] [1698827555.218644073] [turtlebot4_node]: Service start_motor unavailable.
[turtlebot4_node-30] [INFO] [1698827618.620118197] [turtlebot4_node]: Docking
[turtlebot4_node-30] [INFO] [1698827618.620170997] [turtlebot4_node]: Waiting for dock action server
[turtlebot4_node-30] [INFO] [1698827619.620522703] [turtlebot4_node]: dock action server available, sending goal
[motion_control-35] [INFO] [1698827619.620770082] [motion_control]: Received new dock servo goal
[turtlebot4_node-30] [INFO] [1698827619.621009988] [turtlebot4_node]: dock goal accepted by server, waiting for result
[turtlebot4_node-30] [INFO] [1698827632.318106090] [turtlebot4_node]: OAKD stopped
[turtlebot4_node-30] [INFO] [1698827632.318168110] [turtlebot4_node]: RPLIDAR stopped
[motion_control-35] [INFO] [1698827632.550705048] [motion_control]: Dock Servo Goal Succeeded
[turtlebot4_node-30] [INFO] [1698827632.551048040] [turtlebot4_node]: dock goal succeeded
[turtlebot4_node-30] [ERROR] [1698827662.328566332] [turtlebot4_node]: Service oakd/stop_camera unavailable.
[turtlebot4_node-30] [ERROR] [1698827662.338816767] [turtlebot4_node]: Service stop_motor unavailable.
[WARNING] [launch]: user interrupted with ctrl-c (SIGINT)
[static_transform_publisher-45] [INFO] [1698827697.293397055] [rclcpp]: signal_handler(signum=2)
[static_transform_publisher-44] [INFO] [1698827697.293397055] [rclcpp]: signal_handler(signum=2)
[sync_slam_toolbox_node-46] [INFO] [1698827697.293395589] [rclcpp]: signal_handler(signum=2)
[ui_mgr-40] [INFO] [1698827697.293403760] [rclcpp]: signal_handler(signum=2)
[kidnap_estimator_publisher-39] [INFO] [1698827697.293405157] [rclcpp]: signal_handler(signum=2)
[robot_state-38] [INFO] [1698827697.293408440] [rclcpp]: signal_handler(signum=2)
[mock_publisher-37] [INFO] [1698827697.293410325] [rclcpp]: signal_handler(signum=2)
[sensors_node-42] [INFO] [1698827697.293395589] [rclcpp]: signal_handler(signum=2)
[interface_buttons_node-43] [INFO] [1698827697.293399011] [rclcpp]: signal_handler(signum=2)
[ir_intensity_vector_publisher-34] [INFO] [1698827697.293421779] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-29] [INFO] [1698827697.293435189] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-28] [INFO] [1698827697.293443640] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-23] [INFO] [1698827697.293472345] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-21] [INFO] [1698827697.293473252] [rclcpp]: signal_handler(signum=2)
[pose_republisher_node-41] [INFO] [1698827697.293398033] [rclcpp]: signal_handler(signum=2)
[turtlebot4_node-30] [INFO] [1698827697.293479818] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-18] [INFO] [1698827697.293485545] [rclcpp]: signal_handler(signum=2)
[turtlebot4_ignition_hmi_node-31] [INFO] [1698827697.293481284] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-27] [INFO] [1698827697.293534015] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-22] [INFO] [1698827697.293534992] [rclcpp]: signal_handler(signum=2)
[robot_state_publisher-3] [INFO] [1698827697.293534992] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-16] [INFO] [1698827697.293538345] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-13] [INFO] [1698827697.293553012] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-12] [INFO] [1698827697.293572637] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-15] [INFO] [1698827697.293598339] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-26] [INFO] [1698827697.293604136] [rclcpp]: signal_handler(signum=2)
[static_transform_publisher-6] [INFO] [1698827697.293616917] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-11] [INFO] [1698827697.293632631] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-24] [INFO] [1698827697.293671253] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-20] [INFO] [1698827697.293735577] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-2] [INFO] [1698827697.293763514] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-17] [INFO] [1698827697.293792638] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-9] [INFO] [1698827697.293796339] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-25] [INFO] [1698827697.293897889] [rclcpp]: signal_handler(signum=2)
[hazards_vector_publisher-33] [INFO] [1698827697.293566002] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-10] [INFO] [1698827697.294651549] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-19] [INFO] [1698827697.293481284] [rclcpp]: signal_handler(signum=2)
[parameter_bridge-14] [INFO] [1698827697.295189469] [rclcpp]: signal_handler(signum=2)
[robot_state_publisher-5] [INFO] [1698827697.295754208] [rclcpp]: signal_handler(signum=2)
[motion_control-35] [INFO] [1698827697.296475880] [rclcpp]: signal_handler(signum=2)
[wheel_status_publisher-36] [INFO] [1698827697.299089211] [rclcpp]: signal_handler(signum=2)
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::ir_intensity_side_left::ir_intensity_side_left] adv2m[GUI] [Msg] Added plugin [World control] to main window
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loaded plugin [WorldControl] from path [/usr/lib/x86_64-linux-gnu/ign-gui-6/plugins/libWorldControl.so]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:426] Loading plugin [WorldStats]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Listening to stats on [/world/warehouse/stats]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Added plugin [World stats] to main window
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loaded plugin [WorldStats] from path [/usr/lib/x86_64-linux-gnu/ign-gui-6/plugins/libWorldStats.so]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:426] Loading plugin [TransformControl]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [TransformControl.cc:222] Legacy mode is disabled; this plugin must be used with MinimalScene.
[ruby $(which ign) gazebo-1] [GUI] [Msg] Added plugin [Transform control] to main window
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loaded plugin [TransformControl] from path [/usr/lib/x86_64-linux-gnu/ign-gazebo-6/plugins/gui/libTransformControl.so]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:426] Loading plugin [Shapes]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Added plugin [Shapes] to main window
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loaded plugin [Shapes] from path [/usr/lib/x86_64-linux-gnu/ign-gazebo-6/plugins/gui/libShapes.so]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:426] Loading plugin [Turtlebot4Hmi]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Added plugin [Turtlebot4 HMI] to main window
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loaded plugin [Turtlebot4Hmi] from path [/home/shananda/turtlebot4_ws/install/turtlebot4_ignition_gui_plugins/share/turtlebot4_ignition_gui_plugins/lib/libTurtlebot4Hmi.so]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:426] Loading plugin [Teleop]
[ruby $(which ign) gazebo-1] [GUI] [Msg] A new topic has been entered: '/cmd_vel ' 
[ruby $(which ign) gazebo-1] [GUI] [Msg] Added plugin [Teleop] to main window
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loaded plugin [Teleop] from path [/usr/lib/x86_64-linux-gnu/ign-gui-6/plugins/libTeleop.so]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:569] Applying config
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loading plugin [ignition-rendering-ogre2]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [RenderUtil.cc:2588] Create scene [scene]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loading plugin [ignition-rendering-ogre2]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [TransformControl.cc:531] TransformControl plugin is using camera [scene::Camera(65527)]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Scene3D.cc:3310] RenderEngineGuiPlugin component not found, render engine won't be set from the ECM 
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [SignalHandler.cc:141] Received signal[2].
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Gui.cc:472] Shutting down ign-gazebo-gui
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Application.cc:140] Terminating application.
[INFO] [static_transform_publisher-44]: process has finished cleanly [pid 19761]
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:52: TypeError: Cannot read property 'dialogOnExitText' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:54: TypeError: Cannot read property 'exitDialogShowCloseGui' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:53: TypeError: Cannot read property 'exitDialogShowShutdown' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:251: TypeError: Cannot read property 'showDrawer' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:/qml/SideDrawer.qml:93: TypeError: Cannot read property 'showDefaultDrawerOpts' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:/qml/IgnSplit.qml:56: TypeError: Cannot read property 'pluginCount' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:41: TypeError: Cannot read property 'toolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:42: TypeError: Cannot read property 'toolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:43: TypeError: Cannot read property 'toolBarColorDark' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:44: TypeError: Cannot read property 'toolBarTextColorDark' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:45: TypeError: Cannot read property 'pluginToolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:46: TypeError: Cannot read property 'pluginToolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:47: TypeError: Cannot read property 'pluginToolBarColorDark' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:48: TypeError: Cannot read property 'pluginToolBarTextColorDark' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:50: TypeError: Cannot read property 'defaultExitAction' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:51: TypeError: Cannot read property 'showDialogOnExit' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:55: TypeError: Cannot read property 'exitDialogShutdownText' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:56: TypeError: Cannot read property 'exitDialogCloseGuiText' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:66: TypeError: Cannot read property 'toolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:76: TypeError: Cannot read property 'toolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:219: TypeError: Cannot read property 'showPluginMenu' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:202: TypeError: Cannot read property 'showDrawer' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] qrc:qml/Main.qml:188: TypeError: Cannot read property 'showDrawer' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:128: TypeError: Cannot read property 'pluginToolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:139: TypeError: Cannot read property 'pluginToolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:128: TypeError: Cannot read property 'pluginToolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:139: TypeError: Cannot read property 'pluginToolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:128: TypeError: Cannot read property 'pluginToolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:139: TypeError: Cannot read property 'pluginToolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:128: TypeError: Cannot read property 'pluginToolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:139: TypeError: Cannot read property 'pluginToolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:128: TypeError: Cannot read property 'pluginToolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:139: TypeError: Cannot read property 'pluginToolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:128: TypeError: Cannot read property 'pluginToolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:139: TypeError: Cannot read property 'pluginToolBarTextColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:128: TypeError: Cannot read property 'pluginToolBarColorLight' of null
[ruby $(which ign) gazebo-1] [GUI] [Wrn] [Application.cc:797] [QT] file::qml/IgnCard.qml:139: TypeError: Cannot read property 'pluginToolBarTextColorLight' of null
[INFO] [sync_slam_toolbox_node-46]: process has finished cleanly [pid 19803]
[INFO] [robot_state_publisher-5]: process has finished cleanly [pid 19228]
[INFO] [interface_buttons_node-43]: process has finished cleanly [pid 19744]
[INFO] [mock_publisher-37]: process has finished cleanly [pid 19669]
[INFO] [robot_state_publisher-3]: process has finished cleanly [pid 19223]
[INFO] [kidnap_estimator_publisher-39]: process has finished cleanly [pid 19682]
[INFO] [static_transform_publisher-6]: process has finished cleanly [pid 19230]
[INFO] [turtlebot4_ignition_hmi_node-31]: process has finished cleanly [pid 19564]
[INFO] [static_transform_publisher-45]: process has finished cleanly [pid 19798]
[INFO] [ir_intensity_vector_publisher-34]: process has finished cleanly [pid 19612]
[INFO] [hazards_vector_publisher-33]: process has finished cleanly [pid 19604]
[INFO] [robot_state-38]: process has finished cleanly [pid 19671]
[INFO] [wheel_status_publisher-36]: process has finished cleanly [pid 19648]
[INFO] [ui_mgr-40]: process has finished cleanly [pid 19714]
[INFO] [pose_republisher_node-41]: process has finished cleanly [pid 19720]
[ruby $(which ign) gazebo-1] [GUI] [Msg] Loading plugin [ignition-rendering-ogre2]
[ruby $(which ign) gazebo-1] [GUI] [Dbg] [Scene3D.cc:2165] Destroy scene [scene]
[ruby $(which ign) gazebo-1] [INFO] [1698827697.704613954] [rclcpp]: signal_handler(signum=2)
[INFO] [sensors_node-42]: process has finished cleanly [pid 19737]
[INFO] [turtlebot4_node-30]: process has finished cleanly [pid 19555]
[ruby $(which ign) gazebo-1] ertised on [world/warehouse/model/turtlebot4/link/ir_intensity_side_left/sensor/ir_intensity_side_left/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::ir_intensity_side_left::ir_intensity_side_left] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_side_left/sensor/ir_intensity_side_left/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::rplidar_link::rplidar] advertised on [world/warehouse/model/turtlebot4/link/rplidar_link/sensor/rplidar/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [turtlebot4::rplidar_link::rplidar] advertised on [world/warehouse/model/turtlebot4/link/rplidar_link/sensor/rplidar/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [standard_dock::green_buoy_link::green_buoy] advertised on [world/warehouse/model/standard_dock/link/green_buoy_link/sensor/green_buoy/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [standard_dock::green_buoy_link::green_buoy] advertised on [world/warehouse/model/standard_dock/link/green_buoy_link/sensor/green_buoy/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [standard_dock::halo_link::halo] advertised on [world/warehouse/model/standard_dock/link/halo_link/sensor/halo/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [standard_dock::halo_link::halo] advertised on [world/warehouse/model/standard_dock/link/halo_link/sensor/halo/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [standard_dock::red_buoy_link::red_buoy] advertised on [world/warehouse/model/standard_dock/link/red_buoy_link/sensor/red_buoy/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [standard_dock::red_buoy_link::red_buoy] advertised on [world/warehouse/model/standard_dock/link/red_buoy_link/sensor/red_buoy/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [standard_dock::yellow_buoy_link::yellow_buoy] advertised on [world/warehouse/model/standard_dock/link/yellow_buoy_link/sensor/yellow_buoy/scan]
[ruby $(which ign) gazebo-1] [Dbg] [GpuLidarSensor.cc:163] Lidar points for [standard_dock::yellow_buoy_link::yellow_buoy] advertised on [world/warehouse/model/standard_dock/link/yellow_buoy_link/sensor/yellow_buoy/scan/points]
[ruby $(which ign) gazebo-1] [Dbg] [SignalHandler.cc:141] Received signal[2].
[ruby $(which ign) gazebo-1] [Dbg] [ServerPrivate.cc:110] Server received signal[2]
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:423] SensorsPrivate::Stop
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:409] SensorsPrivate::RenderThread stopped
[ruby $(which ign) gazebo-1] [Dbg] [gz.cc:410] Shutting down ign-gazebo-server
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:523] Exiting postupdate worker thread (2)
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:523] Exiting postupdate worker thread (4Exiting postupdate worker thread (1)
[ruby $(which ign) gazebo-1] )
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:523] Exiting postupdate worker thread (0)
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:523] Exiting postupdate worker thread (5)
[ruby $(which ign) gazebo-1] 
[INFO] [joint_state_publisher-4]: process has finished cleanly [pid 19225]
[INFO] [motion_control-35]: process has finished cleanly [pid 19636]
[ruby $(which ign) gazebo-1] [Dbg] [SimulationRunner.cc:523] Exiting postupdate worker thread (3)
[ruby $(which ign) gazebo-1] [Dbg] [Sensors.cc:423] SensorsPrivate::Stop
[ERROR] [ruby $(which ign) gazebo-1]: process has died [pid 19218, exit code -2, cmd 'ruby $(which ign) gazebo my_world.sdf -v 4 --gui-config /home/shananda/turtlebot4_ws/install/turtlebot4_ignition_bringup/share/turtlebot4_ignition_bringup/gui/standard/gui.config --force-version 6'].
[ERROR] [rviz2-47]: process has died [pid 19819, exit code -11, cmd '/opt/ros/humble/lib/rviz2/rviz2 -d /home/shananda/turtlebot4_ws/install/turtlebot4_viz/share/turtlebot4_viz/rviz/robot.rviz --ros-args -r __node:=rviz2 -r __ns:=/ --params-file /tmp/launch_params_5m9n54lc -r /tf:=tf -r /tf_static:=tf_static'].
[ERROR] [parameter_bridge-29]: process[parameter_bridge-29] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-28]: process[parameter_bridge-28] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-27]: process[parameter_bridge-27] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-26]: process[parameter_bridge-26] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-25]: process[parameter_bridge-25] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-24]: process[parameter_bridge-24] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-23]: process[parameter_bridge-23] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-22]: process[parameter_bridge-22] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-21]: process[parameter_bridge-21] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-20]: process[parameter_bridge-20] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-19]: process[parameter_bridge-19] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-18]: process[parameter_bridge-18] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-17]: process[parameter_bridge-17] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-16]: process[parameter_bridge-16] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-15]: process[parameter_bridge-15] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-14]: process[parameter_bridge-14] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-13]: process[parameter_bridge-13] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-12]: process[parameter_bridge-12] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[INFO] [parameter_bridge-29]: sending signal 'SIGTERM' to process[parameter_bridge-29]
[ERROR] [parameter_bridge-11]: process[parameter_bridge-11] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-10]: process[parameter_bridge-10] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[ERROR] [parameter_bridge-9]: process[parameter_bridge-9] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[INFO] [parameter_bridge-28]: sending signal 'SIGTERM' to process[parameter_bridge-28]
[ERROR] [parameter_bridge-2]: process[parameter_bridge-2] failed to terminate '5' seconds after receiving 'SIGINT', escalating to 'SIGTERM'
[INFO] [parameter_bridge-27]: sending signal 'SIGTERM' to process[parameter_bridge-27]
[INFO] [parameter_bridge-26]: sending signal 'SIGTERM' to process[parameter_bridge-26]
[INFO] [parameter_bridge-25]: sending signal 'SIGTERM' to process[parameter_bridge-25]
[INFO] [parameter_bridge-24]: sending signal 'SIGTERM' to process[parameter_bridge-24]
[INFO] [parameter_bridge-23]: sending signal 'SIGTERM' to process[parameter_bridge-23]
[INFO] [parameter_bridge-22]: sending signal 'SIGTERM' to process[parameter_bridge-22]
[INFO] [parameter_bridge-21]: sending signal 'SIGTERM' to process[parameter_bridge-21]
[INFO] [parameter_bridge-20]: sending signal 'SIGTERM' to process[parameter_bridge-20]
[INFO] [parameter_bridge-19]: sending signal 'SIGTERM' to process[parameter_bridge-19]
[INFO] [parameter_bridge-18]: sending signal 'SIGTERM' to process[parameter_bridge-18]
[INFO] [parameter_bridge-17]: sending signal 'SIGTERM' to process[parameter_bridge-17]
[INFO] [parameter_bridge-16]: sending signal 'SIGTERM' to process[parameter_bridge-16]
[INFO] [parameter_bridge-15]: sending signal 'SIGTERM' to process[parameter_bridge-15]
[INFO] [parameter_bridge-14]: sending signal 'SIGTERM' to process[parameter_bridge-14]
[INFO] [parameter_bridge-13]: sending signal 'SIGTERM' to process[parameter_bridge-13]
[INFO] [parameter_bridge-12]: sending signal 'SIGTERM' to process[parameter_bridge-12]
[INFO] [parameter_bridge-29]: process has finished cleanly [pid 19541]
[INFO] [parameter_bridge-11]: sending signal 'SIGTERM' to process[parameter_bridge-11]
[INFO] [parameter_bridge-28]: process has finished cleanly [pid 19521]
[INFO] [parameter_bridge-10]: sending signal 'SIGTERM' to process[parameter_bridge-10]
[INFO] [parameter_bridge-27]: process has finished cleanly [pid 19492]
[INFO] [parameter_bridge-9]: sending signal 'SIGTERM' to process[parameter_bridge-9]
[INFO] [parameter_bridge-26]: process has finished cleanly [pid 19458]
[INFO] [parameter_bridge-2]: sending signal 'SIGTERM' to process[parameter_bridge-2]
[INFO] [parameter_bridge-25]: process has finished cleanly [pid 19425]
[INFO] [parameter_bridge-24]: process has finished cleanly [pid 19398]
[INFO] [parameter_bridge-23]: process has finished cleanly [pid 19387]
[INFO] [parameter_bridge-22]: process has finished cleanly [pid 19372]
[INFO] [parameter_bridge-21]: process has finished cleanly [pid 19325]
[INFO] [parameter_bridge-20]: process has finished cleanly [pid 19291]
[INFO] [parameter_bridge-19]: process has finished cleanly [pid 19287]
[INFO] [parameter_bridge-18]: process has finished cleanly [pid 19285]
[INFO] [parameter_bridge-17]: process has finished cleanly [pid 19277]
[INFO] [parameter_bridge-16]: process has finished cleanly [pid 19254]
[INFO] [parameter_bridge-15]: process has finished cleanly [pid 19252]
[INFO] [parameter_bridge-14]: process has finished cleanly [pid 19250]
[INFO] [parameter_bridge-13]: process has finished cleanly [pid 19248]
[INFO] [parameter_bridge-12]: process has finished cleanly [pid 19246]
[INFO] [parameter_bridge-11]: process has finished cleanly [pid 19242]
[INFO] [parameter_bridge-10]: process has finished cleanly [pid 19238]
[INFO] [parameter_bridge-9]: process has finished cleanly [pid 19236]
[INFO] [parameter_bridge-2]: process has finished cleanly [pid 19220]`

As far as I can tell, the topics rviz is subscribing to is dependent on the 'warehouse' world name, such as

[ruby $(which ign) gazebo-1] [Dbg] [Lidar.cc:132] Laser scans for [turtlebot4::ir_intensity_front_left::ir_intensity_front_left] advertised on [world/warehouse/model/turtlebot4/link/ir_intensity_front_left/sensor/ir_intensity_front_left/scan]
hilary-luo commented 11 months ago

@HyydenJakcz Can you please also describe to me what you are seeing in Gazebo, do you see the world spawn properly? Are you able to echo the scan topic?

And finally, can you please attach your custom world file that is not working?

HyydenJakcz commented 11 months ago

My world spawns in properly in gazebo and I am able to move the turtlebo t as expected. The only problem is that rviz does not show anything. The scan topic is also showing expected values. Here is my world file, it uses custom models in .dae format which I included world file.zip

Also, the turtlebot has to be spawned in the coordinates (-4.2, 0.18)

hilary-luo commented 10 months ago

@HyydenJakcz Thank you for your patience. The reason that it is not working is that the name of the world file must match the name referenced inside the world file. This is used to bridge gazebo topics to ros topics. So change the beginning of your world file as such:

<?xml version="1.0"?>
<sdf version="1.4">
  <world name="my_world">    <!-- This line must match the name of the file, e.g. this is for my_world.sdf -->
...
HyydenJakcz commented 10 months ago

Thank you for the help! I followed your suggestion. I thought I had done it previously but I forgot to also colcon build the workspace afterwards so that gazebo can find my world file.

ncnynl commented 2 months ago

Today I reinstalled the humble version of turtlebot4 on ubuntu22.04 on nuc, and changed it to ogre2, which can get the laser data normally. It is running smoothly now.

I wrote a script https://github.com/ncnynl/commands/blob/master/commands_extra/ros2_tb4/shell/install_tb4_humble_source.sh

Method:

# install rcm 
curl https://www.ncnynl.com/rcm.sh | bash - 

install turtlebot4

rcm -s install_tb4_humble_source

Check scan:

ros2 launch turtlebot4_ignition_bringup turtlebot4 _ignition.launch.py 
​​ros2 topic echo /scan 

SLAM:

ros2 launch turtlebot4_ignition_bringup turtlebot4_ignition.launch.py ​​slam:=true nav2:=true rviz:=true