go2_ros2_sdk: Can't see lidar's points and mapping

Hi,

It’s really weird, i succesfully connect with the unitree go2 edu via webrtc, as you can see in the next screenshoot, it’s possible to see the camera, but lidar is not showing any points.

Image

But one thing that i do not understand is that, yesterday, i was trying the same thing, i didn’t get it but i had to leave the room and then when i came suddenly it was working, indeed i saved a map too, but today it doesn’t want to work.

I’m connecting as i said via webrtc with the IP that my router gave to the robot, i get this ip form unitree app.

I also checked the console, and i saw theses messages, idk if it could be related: [controller_server-11] [WARN] [1747907910.125239333] [local_costmap.local_costmap]: Can't update static costmap layer, no map received [planner_server-13] [WARN] [1747907911.717838446] [global_costmap.global_costmap]: Can't update static costmap layer, no map received [controller_server-11] [WARN] [1747907920.125269035] [local_costmap.local_costmap]: Can't update static costmap layer, no map received [planner_server-13] [WARN] [1747907921.727976600] [global_costmap.global_costmap]: Can't update static costmap layer, no map received [controller_server-11] [WARN] [1747907930.125057725] [local_costmap.local_costmap]: Can't update static costmap layer, no map received [planner_server-13] [WARN] [1747907931.756137487] [global_costmap.global_costmap]: Can't update static costmap layer, no map received [controller_server-11] [WARN] [1747907940.125073672] [local_costmap.local_costmap]: Can't update static costmap layer, no map received [planner_server-13] [WARN] [1747907941.725433330] [global_costmap.global_costmap]: Can't update static costmap layer, no map received [controller_server-11] [WARN] [1747907950.125033724] [local_costmap.local_costmap]: Can't update static costmap layer, no map received [planner_server-13] [WARN] [1747907951.762299039] [global_costmap.global_costmap]: Can't update static costmap layer, no map received [controller_server-11] [WARN] [1747907960.125068404] [local_costmap.local_costmap]: Can't update static costmap layer, no map received [planner_server-13] [WARN] [1747907961.742283496] [global_costmap.global_costmap]: Can't update static costmap layer, no map received [go2_driver_node-3] [h264 @ 0x76e50c000e40] No start code is found. [go2_driver_node-3] [h264 @ 0x76e50c000e40] Error splitting the input into NAL units. [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [go2_driver_node-3] [h264 @ 0x76e50c000e40] No start code is found. [go2_driver_node-3] [h264 @ 0x76e50c000e40] Error splitting the input into NAL units. [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [controller_server-11] [WARN] [1747907970.125090291] [local_costmap.local_costmap]: Can't update static costmap layer, no map received [planner_server-13] [WARN] [1747907971.751432347] [global_costmap.global_costmap]: Can't update static costmap layer, no map received

Thanks for your help guys.

About this issue

  • Original URL
  • State: open
  • Created a year ago
  • Comments: 20 (1 by maintainers)

Most upvoted comments

try to start the robot in non AI mode or try the feat/obstacle_avoid branch

Hi @tfoldi thanks for your comment, at the moment, due to the last firmware update, I can’t change between different modes from the app, it’s like they have removed it and it’s always working in a “default” mode which mixes all the past modes that it had (general, classic, AI or something like that) it’s really weird rn. About the branch, I pretend to try it tomorrow. Thanks all for your support, I will keep this issue updated as soon as I know something.

Hello @maciejmajek @p82garpr ! I don’t update my dog firmware, I am using the 1.0.x version, we had the same problems with 1.1.1, when the webrtc method didn’t work, and we reupdated it. Currently, this SDK supports: 1.1.1 - 1.1.7 (latest available) 1.0.19 - 1.0.25

btw, I don’t have a physical robot with me right now to debug it, but I think someone from the Roboverse can fix that soon, and I will update my repo to support a new version

INFO] [launch]: All log files can be found below /home/deuser/.ros/log/2025-05-22-12-04-16-080725-deuser-114196 [INFO] [launch]: Default logging verbosity is set to INFO IP list: ['192.168.0.100'] [INFO] [robot_state_publisher-1]: process started with pid [114205] [INFO] [pointcloud_to_laserscan_node-2]: process started with pid [114207] [INFO] [go2_driver_node-3]: process started with pid [114209] [INFO] [lidar_to_pointcloud-4]: process started with pid [114211] [INFO] [rviz2-5]: process started with pid [114214] [INFO] [joy_node-6]: process started with pid [114219] [INFO] [teleop_node-7]: process started with pid [114229] [INFO] [twist_mux-8]: process started with pid [114232] [INFO] [foxglove_bridge-9]: process started with pid [114238] [INFO] [async_slam_toolbox_node-10]: process started with pid [114241] [INFO] [controller_server-11]: process started with pid [114246] [INFO] [smoother_server-12]: process started with pid [114249] [INFO] [planner_server-13]: process started with pid [114251] [INFO] [behavior_server-14]: process started with pid [114254] [INFO] [bt_navigator-15]: process started with pid [114259] [INFO] [waypoint_follower-16]: process started with pid [114266] [INFO] [velocity_smoother-17]: process started with pid [114274] [INFO] [lifecycle_manager-18]: process started with pid [114289] [robot_state_publisher-1] [INFO] [1747908256.569201305] [robot_state_publisher]: got segment FL_calf [robot_state_publisher-1] [INFO] [1747908256.569302850] [robot_state_publisher]: got segment FL_calflower [robot_state_publisher-1] [INFO] [1747908256.569313380] [robot_state_publisher]: got segment FL_calflower1 [robot_state_publisher-1] [INFO] [1747908256.569319512] [robot_state_publisher]: got segment FL_foot [robot_state_publisher-1] [INFO] [1747908256.569325250] [robot_state_publisher]: got segment FL_hip [robot_state_publisher-1] [INFO] [1747908256.569330947] [robot_state_publisher]: got segment FL_thigh [robot_state_publisher-1] [INFO] [1747908256.569336552] [robot_state_publisher]: got segment FR_calf [robot_state_publisher-1] [INFO] [1747908256.569342070] [robot_state_publisher]: got segment FR_calflower [robot_state_publisher-1] [INFO] [1747908256.569347833] [robot_state_publisher]: got segment FR_calflower1 [robot_state_publisher-1] [INFO] [1747908256.569353411] [robot_state_publisher]: got segment FR_foot [robot_state_publisher-1] [INFO] [1747908256.569358821] [robot_state_publisher]: got segment FR_hip [robot_state_publisher-1] [INFO] [1747908256.569364258] [robot_state_publisher]: got segment FR_thigh [robot_state_publisher-1] [INFO] [1747908256.569369758] [robot_state_publisher]: got segment Head_lower [robot_state_publisher-1] [INFO] [1747908256.569375169] [robot_state_publisher]: got segment Head_upper [robot_state_publisher-1] [INFO] [1747908256.569380669] [robot_state_publisher]: got segment RL_calf [robot_state_publisher-1] [INFO] [1747908256.569386133] [robot_state_publisher]: got segment RL_calflower [robot_state_publisher-1] [INFO] [1747908256.569391759] [robot_state_publisher]: got segment RL_calflower1 [robot_state_publisher-1] [INFO] [1747908256.569397261] [robot_state_publisher]: got segment RL_foot [robot_state_publisher-1] [INFO] [1747908256.569402734] [robot_state_publisher]: got segment RL_hip [robot_state_publisher-1] [INFO] [1747908256.569408172] [robot_state_publisher]: got segment RL_thigh [robot_state_publisher-1] [INFO] [1747908256.569413604] [robot_state_publisher]: got segment RR_calf [robot_state_publisher-1] [INFO] [1747908256.569418988] [robot_state_publisher]: got segment RR_calflower [robot_state_publisher-1] [INFO] [1747908256.569424604] [robot_state_publisher]: got segment RR_calflower1 [robot_state_publisher-1] [INFO] [1747908256.569430001] [robot_state_publisher]: got segment RR_foot [robot_state_publisher-1] [INFO] [1747908256.569435523] [robot_state_publisher]: got segment RR_hip [robot_state_publisher-1] [INFO] [1747908256.569440896] [robot_state_publisher]: got segment RR_thigh [robot_state_publisher-1] [INFO] [1747908256.569446319] [robot_state_publisher]: got segment base_footprint [robot_state_publisher-1] [INFO] [1747908256.569451820] [robot_state_publisher]: got segment base_link [robot_state_publisher-1] [INFO] [1747908256.569457371] [robot_state_publisher]: got segment front_camera [robot_state_publisher-1] [INFO] [1747908256.569462925] [robot_state_publisher]: got segment imu [robot_state_publisher-1] [INFO] [1747908256.569468731] [robot_state_publisher]: got segment map [robot_state_publisher-1] [INFO] [1747908256.569474443] [robot_state_publisher]: got segment odom [robot_state_publisher-1] [INFO] [1747908256.569479984] [robot_state_publisher]: got segment radar [rviz2-5] Warning: Ignoring XDG_SESSION_TYPE=wayland on Gnome. Use QT_QPA_PLATFORM=wayland to run on Wayland anyway. [twist_mux-8] [INFO] [1747908256.699175961] [twist_mux]: Topic handler 'topics.joy' subscribed to topic 'cmd_vel_joy': timeout = 0.500000s , priority = 10. [twist_mux-8] [INFO] [1747908256.707631685] [twist_mux]: Topic handler 'topics.navigation' subscribed to topic 'cmd_vel': timeout = 0.500000s , priority = 5. [controller_server-11] [INFO] [1747908256.721607427] [controller_server]: [controller_server-11] controller_server lifecycle node launched. [controller_server-11] Waiting on external lifecycle transitions to activate [controller_server-11] See https://design.ros2.org/articles/node_lifecycle.html for more information. [teleop_node-7] [INFO] [1747908256.763974103] [TeleopTwistJoy]: Linear axis x on 1 at scale 0.200000. [teleop_node-7] [INFO] [1747908256.764037952] [TeleopTwistJoy]: Linear axis y on 3 at scale 0.200000. [teleop_node-7] [INFO] [1747908256.764046331] [TeleopTwistJoy]: Angular axis yaw on 6 at scale 0.200000. [controller_server-11] [INFO] [1747908256.770884840] [controller_server]: Creating controller server [async_slam_toolbox_node-10] [INFO] [1747908256.844089670] [slam_toolbox]: Node using stack size 40000000 [smoother_server-12] [INFO] [1747908256.859644148] [smoother_server]: [smoother_server-12] smoother_server lifecycle node launched. [smoother_server-12] Waiting on external lifecycle transitions to activate [smoother_server-12] See https://design.ros2.org/articles/node_lifecycle.html for more information. [smoother_server-12] [INFO] [1747908256.875614075] [smoother_server]: Creating smoother server [planner_server-13] [INFO] [1747908256.886114459] [planner_server]: [planner_server-13] planner_server lifecycle node launched. [planner_server-13] Waiting on external lifecycle transitions to activate [planner_server-13] See https://design.ros2.org/articles/node_lifecycle.html for more information. [foxglove_bridge-9] [INFO] [1747908256.902872089] [foxglove_bridge_component_manager]: Load Library: /opt/ros/humble/lib/libfoxglove_bridge_component.so [planner_server-13] [INFO] [1747908256.913124876] [planner_server]: Creating [controller_server-11] [INFO] [1747908256.960433709] [local_costmap.local_costmap]: [controller_server-11] local_costmap lifecycle node launched. [controller_server-11] Waiting on external lifecycle transitions to activate [controller_server-11] See https://design.ros2.org/articles/node_lifecycle.html for more information. [controller_server-11] [INFO] [1747908256.960915105] [local_costmap.local_costmap]: Creating Costmap [behavior_server-14] [INFO] [1747908256.967627111] [behavior_server]: [behavior_server-14] behavior_server lifecycle node launched. [behavior_server-14] Waiting on external lifecycle transitions to activate [behavior_server-14] See https://design.ros2.org/articles/node_lifecycle.html for more information. [foxglove_bridge-9] [INFO] [1747908256.980616482] [foxglove_bridge_component_manager]: Found class: rclcpp_components::NodeFactoryTemplate<foxglove_bridge::FoxgloveBridge> [foxglove_bridge-9] [INFO] [1747908256.992463729] [foxglove_bridge_component_manager]: Instantiate class: rclcpp_components::NodeFactoryTemplate<foxglove_bridge::FoxgloveBridge> [velocity_smoother-17] [INFO] [1747908256.993596967] [velocity_smoother]: [velocity_smoother-17] velocity_smoother lifecycle node launched. [velocity_smoother-17] Waiting on external lifecycle transitions to activate [velocity_smoother-17] See https://design.ros2.org/articles/node_lifecycle.html for more information. [bt_navigator-15] [INFO] [1747908257.015027952] [bt_navigator]: [bt_navigator-15] bt_navigator lifecycle node launched. [bt_navigator-15] Waiting on external lifecycle transitions to activate [bt_navigator-15] See https://design.ros2.org/articles/node_lifecycle.html for more information. [bt_navigator-15] [INFO] [1747908257.015151020] [bt_navigator]: Creating [foxglove_bridge-9] [INFO] [1747908257.026765895] [foxglove_bridge]: Starting foxglove_bridge (humble, 0.8.3@) with WebSocket++/0.8.2 [foxglove_bridge-9] [INFO] [1747908257.027348225] [foxglove_bridge]: [WS] Server running without TLS [foxglove_bridge-9] [INFO] [1747908257.027616032] [foxglove_bridge]: [WS] WebSocket server listening at ws://0.0.0.0:8765 [foxglove_bridge-9] [INFO] [1747908257.028819027] [foxglove_bridge]: [WS] WebSocket server run loop started [planner_server-13] [INFO] [1747908257.033883172] [global_costmap.global_costmap]: [planner_server-13] global_costmap lifecycle node launched. [planner_server-13] Waiting on external lifecycle transitions to activate [planner_server-13] See https://design.ros2.org/articles/node_lifecycle.html for more information. [planner_server-13] [INFO] [1747908257.034335137] [global_costmap.global_costmap]: Creating Costmap [waypoint_follower-16] [INFO] [1747908257.036759695] [waypoint_follower]: [waypoint_follower-16] waypoint_follower lifecycle node launched. [waypoint_follower-16] Waiting on external lifecycle transitions to activate [waypoint_follower-16] See https://design.ros2.org/articles/node_lifecycle.html for more information. [waypoint_follower-16] [INFO] [1747908257.037268402] [waypoint_follower]: Creating [lifecycle_manager-18] [INFO] [1747908257.058381124] [lifecycle_manager_navigation]: Creating [lifecycle_manager-18] [INFO] [1747908257.122478838] [lifecycle_manager_navigation]: Creating and initializing lifecycle service clients [pointcloud_to_laserscan_node-2] [INFO] [1747908257.265954193] [pointcloud_to_laserscan]: Got a subscriber to laserscan, starting pointcloud subscriber [lifecycle_manager-18] [INFO] [1747908257.321225501] [lifecycle_manager_navigation]: Starting managed nodes bringup... [lifecycle_manager-18] [INFO] [1747908257.321290314] [lifecycle_manager_navigation]: Configuring controller_server [controller_server-11] [INFO] [1747908257.321675401] [controller_server]: Configuring controller interface [controller_server-11] [INFO] [1747908257.324004948] [controller_server]: getting goal checker plugins.. [controller_server-11] [INFO] [1747908257.327263178] [controller_server]: Controller frequency set to 3.0000Hz [controller_server-11] [INFO] [1747908257.327325926] [local_costmap.local_costmap]: Configuring [async_slam_toolbox_node-10] [INFO] [1747908257.327416068] [slam_toolbox]: Using solver plugin solver_plugins::CeresSolver [async_slam_toolbox_node-10] [INFO] [1747908257.327711832] [slam_toolbox]: CeresSolver: Using SCHUR_JACOBI preconditioner. [controller_server-11] [INFO] [1747908257.373246589] [local_costmap.local_costmap]: Using plugin "static_layer" [controller_server-11] [INFO] [1747908257.392627154] [local_costmap.local_costmap]: Subscribing to the map topic (/map) with transient local durability [controller_server-11] [INFO] [1747908257.405514286] [local_costmap.local_costmap]: Initialized plugin "static_layer" [controller_server-11] [INFO] [1747908257.405789899] [local_costmap.local_costmap]: Using plugin "voxel_layer" [controller_server-11] [INFO] [1747908257.413168317] [local_costmap.local_costmap]: Subscribed to Topics: scan [controller_server-11] [INFO] [1747908257.436650826] [local_costmap.local_costmap]: Initialized plugin "voxel_layer" [controller_server-11] [INFO] [1747908257.436689168] [local_costmap.local_costmap]: Using plugin "inflation_layer" [controller_server-11] [INFO] [1747908257.442014294] [local_costmap.local_costmap]: Initialized plugin "inflation_layer" [controller_server-11] [ERROR] [1747908257.463834216] [local_costmap.local_costmap]: The configured inflation radius (0.100) is smaller than the computed inscribed radius (0.210) of your footprint, it is highly recommended to set inflation radius to be at least as big as the inscribed radius to avoid collisions [controller_server-11] [INFO] [1747908257.479317815] [controller_server]: Created progress_checker : progress_checker of type nav2_controller::SimpleProgressChecker [controller_server-11] [INFO] [1747908257.481017792] [controller_server]: Created goal checker : general_goal_checker of type nav2_controller::SimpleGoalChecker [controller_server-11] [INFO] [1747908257.482991311] [controller_server]: Controller Server has general_goal_checker goal checkers available. [controller_server-11] [INFO] [1747908257.484956579] [controller_server]: Created controller : FollowPath of type dwb_core::DWBLocalPlanner [controller_server-11] [INFO] [1747908257.488330320] [controller_server]: Setting transform_tolerance to 0.200000 [controller_server-11] [INFO] [1747908257.513559281] [controller_server]: Using critic "RotateToGoal" (dwb_critics::RotateToGoalCritic) [controller_server-11] [INFO] [1747908257.513799745] [controller_server]: Critic plugin initialized [controller_server-11] [INFO] [1747908257.513882522] [controller_server]: Using critic "Oscillation" (dwb_critics::OscillationCritic) [controller_server-11] [INFO] [1747908257.514098327] [controller_server]: Critic plugin initialized [controller_server-11] [INFO] [1747908257.514182750] [controller_server]: Using critic "BaseObstacle" (dwb_critics::BaseObstacleCritic) [controller_server-11] [INFO] [1747908257.514275484] [controller_server]: Critic plugin initialized [controller_server-11] [INFO] [1747908257.514342589] [controller_server]: Using critic "GoalAlign" (dwb_critics::GoalAlignCritic) [controller_server-11] [INFO] [1747908257.514565512] [controller_server]: Critic plugin initialized [controller_server-11] [INFO] [1747908257.514624926] [controller_server]: Using critic "PathAlign" (dwb_critics::PathAlignCritic) [controller_server-11] [INFO] [1747908257.514813103] [controller_server]: Critic plugin initialized [controller_server-11] [INFO] [1747908257.514868040] [controller_server]: Using critic "PathDist" (dwb_critics::PathDistCritic) [controller_server-11] [INFO] [1747908257.524410241] [controller_server]: Critic plugin initialized [controller_server-11] [INFO] [1747908257.524883819] [controller_server]: Using critic "GoalDist" (dwb_critics::GoalDistCritic) [controller_server-11] [INFO] [1747908257.528054509] [controller_server]: Critic plugin initialized [controller_server-11] [INFO] [1747908257.528109086] [controller_server]: Controller Server has FollowPath controllers available. [lifecycle_manager-18] [INFO] [1747908257.562188146] [lifecycle_manager_navigation]: Configuring smoother_server [smoother_server-12] [INFO] [1747908257.562453448] [smoother_server]: Configuring smoother server [smoother_server-12] [INFO] [1747908257.597530993] [smoother_server]: Created smoother : simple_smoother of type nav2_smoother::SimpleSmoother [smoother_server-12] [INFO] [1747908257.603936138] [smoother_server]: Smoother Server has simple_smoother smoothers available. [lifecycle_manager-18] [INFO] [1747908257.634155568] [lifecycle_manager_navigation]: Configuring planner_server [planner_server-13] [INFO] [1747908257.634664803] [planner_server]: Configuring [planner_server-13] [INFO] [1747908257.634699170] [global_costmap.global_costmap]: Configuring [rviz2-5] [INFO] [1747908257.759599260] [rviz2]: Stereo is NOT SUPPORTED [rviz2-5] [INFO] [1747908257.762614519] [rviz2]: OpenGl version: 4.6 (GLSL 4.6) [rviz2-5] [INFO] [1747908257.802669541] [rviz2]: Stereo is NOT SUPPORTED [go2_driver_node-3] [go2_driver_node-3] A module that was compiled using NumPy 1.x cannot be run in [go2_driver_node-3] NumPy 2.2.6 as it may crash. To support both 1.x and 2.x [go2_driver_node-3] versions of NumPy, modules must be compiled with NumPy 2.0. [go2_driver_node-3] Some module may need to rebuild instead e.g. with 'pybind11>=2.12'. [go2_driver_node-3] [go2_driver_node-3] If you are a user of the module, the easiest solution will be to [go2_driver_node-3] downgrade to 'numpy<2' or try to upgrade the affected module. [go2_driver_node-3] We expect that some modules will need time to support NumPy 2. [go2_driver_node-3] [go2_driver_node-3] Traceback (most recent call last): File "/home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/go2_robot_sdk/go2_driver_node", line 33, in <module> [go2_driver_node-3] sys.exit(load_entry_point('go2-robot-sdk==0.0.0', 'console_scripts', 'go2_driver_node')()) [go2_driver_node-3] File "/home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/go2_robot_sdk/go2_driver_node", line 25, in importlib_load_entry_point [go2_driver_node-3] return next(matches).load() [go2_driver_node-3] File "/usr/lib/python3.10/importlib/metadata/__init__.py", line 171, in load [go2_driver_node-3] module = import_module(match.group('module')) [go2_driver_node-3] File "/usr/lib/python3.10/importlib/__init__.py", line 126, in import_module [go2_driver_node-3] return _bootstrap._gcd_import(name[level:], package, level) [go2_driver_node-3] File "/home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/python3.10/site-packages/go2_robot_sdk/go2_driver_node.py", line 32, in <module> [go2_driver_node-3] from cv_bridge import CvBridge [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/cv_bridge/__init__.py", line 6, in <module> [go2_driver_node-3] from cv_bridge.boost.cv_bridge_boost import cvtColorForDisplay, getCvType [planner_server-13] [INFO] [1747908257.969516174] [global_costmap.global_costmap]: Using plugin "static_layer" [planner_server-13] [INFO] [1747908257.977092536] [global_costmap.global_costmap]: Subscribing to the map topic (/map) with transient local durability [planner_server-13] [INFO] [1747908257.983686555] [global_costmap.global_costmap]: Initialized plugin "static_layer" [planner_server-13] [INFO] [1747908257.983735667] [global_costmap.global_costmap]: Using plugin "voxel_layer" [planner_server-13] [INFO] [1747908257.986263771] [global_costmap.global_costmap]: Subscribed to Topics: scan [go2_driver_node-3] AttributeError: _ARRAY_API not found [pointcloud_to_laserscan_node-2] [WARN] [1747908258.127005004] [pointcloud_to_laserscan]: New subscription discovered on topic '/scan', requesting incompatible QoS. No messages will be sent to it. Last incompatible policy: RELIABILITY_QOS_POLICY [rviz2-5] [WARN] [1747908258.353114769] [rcl.logging_rosout]: Publisher already registered for provided node name. If this is due to multiple nodes with the same name then all logs for that logger name will go out over the existing publisher. As soon as any node with that name is destructed it will unregister the publisher, preventing any further logs for that name from being published on the rosout topic. [rviz2-5] [WARN] [1747908258.447780151] [rcl.logging_rosout]: Publisher already registered for provided node name. If this is due to multiple nodes with the same name then all logs for that logger name will go out over the existing publisher. As soon as any node with that name is destructed it will unregister the publisher, preventing any further logs for that name from being published on the rosout topic. [go2_driver_node-3] [INFO] [1747908258.902470609] [go2_driver_node]: Received ip list: ['192.168.0.100'] [go2_driver_node-3] [INFO] [1747908258.903094380] [go2_driver_node]: Connection type is webrtc [go2_driver_node-3] [INFO] [1747908258.904862058] [go2_driver_node]: Connection mode is single [go2_driver_node-3] [INFO] [1747908258.905444219] [go2_driver_node]: Enable video is True [go2_driver_node-3] [INFO] [1747908258.906186475] [go2_driver_node]: Decode lidar is True [go2_driver_node-3] [INFO] [1747908258.906758247] [go2_driver_node]: Publish raw voxel is False [planner_server-13] [INFO] [1747908258.915858345] [global_costmap.global_costmap]: Initialized plugin "voxel_layer" [planner_server-13] [INFO] [1747908258.915922024] [global_costmap.global_costmap]: Using plugin "inflation_layer" [planner_server-13] [INFO] [1747908258.939084146] [global_costmap.global_costmap]: Initialized plugin "inflation_layer" [planner_server-13] [ERROR] [1747908258.967164727] [global_costmap.global_costmap]: The configured inflation radius (0.100) is smaller than the computed inscribed radius (0.210) of your footprint, it is highly recommended to set inflation radius to be at least as big as the inscribed radius to avoid collisions [go2_driver_node-3] INFO:scripts.go2_camerainfo:Loading camera info from file: /home/deuser/Desktop/unitree/install/go2_robot_sdk/share/go2_robot_sdk/calibration/front_camera.yaml [planner_server-13] [INFO] [1747908258.998868629] [planner_server]: Created global planner plugin GridBased of type nav2_smac_planner/SmacPlannerHybrid [planner_server-13] [INFO] [1747908259.000687906] [planner_server]: Configuring GridBased of type SmacPlannerHybrid [go2_driver_node-3] INFO:root:Trying to send SDP using a NEW method... [planner_server-13] [INFO] [1747908259.018433050] [planner_server]: Even sized heuristic lookup table size set 400.000000, increasing size by 1 to make odd [go2_driver_node-3] INFO:scripts.webrtc_driver:Connection state is connecting [go2_driver_node-3] INFO:aioice.ice:Connection(1) Discovered peer reflexive candidate Candidate(NxIBQZBQHP 1 udp 2130706431 192.168.0.100 44910 typ prflx) [go2_driver_node-3] INFO:aioice.ice:Connection(1) Check CandidatePair(('192.168.0.104', 60375) -> ('192.168.0.100', 44910)) State.WAITING -> State.IN_PROGRESS [go2_driver_node-3] INFO:aioice.ice:Connection(1) Discovered peer reflexive candidate Candidate(bSD7tXJ3mv 1 udp 2130706431 192.168.123.161 33789 typ prflx) [go2_driver_node-3] INFO:aioice.ice:Connection(1) Check CandidatePair(('192.168.0.104', 60375) -> ('192.168.123.161', 33789)) State.WAITING -> State.IN_PROGRESS [go2_driver_node-3] INFO:aioice.ice:Connection(1) Check CandidatePair(('192.168.0.104', 60375) -> ('192.168.0.100', 44910)) State.IN_PROGRESS -> State.SUCCEEDED [go2_driver_node-3] INFO:aioice.ice:Connection(1) Check CandidatePair(('192.168.0.104', 60375) -> ('192.168.0.100', 44910)) State.FROZEN -> State.FAILED [go2_driver_node-3] INFO:aioice.ice:Connection(1) Check CandidatePair(('172.17.0.1', 34234) -> ('192.168.0.100', 44910)) State.FROZEN -> State.FAILED [go2_driver_node-3] INFO:aioice.ice:Connection(1) Check CandidatePair(('192.168.0.104', 60375) -> ('192.168.123.161', 33789)) State.FROZEN -> State.FAILED [go2_driver_node-3] INFO:aioice.ice:Connection(1) Check CandidatePair(('172.17.0.1', 34234) -> ('192.168.123.161', 33789)) State.FROZEN -> State.FAILED [go2_driver_node-3] INFO:aioice.ice:Connection(1) ICE completed [go2_driver_node-3] INFO:scripts.webrtc_driver:Receiving video [rviz2-5] [INFO] [1747908259.573645464] [rviz2]: Stereo is NOT SUPPORTED [go2_driver_node-3] INFO:scripts.webrtc_driver:Connection state is connected [go2_driver_node-3] INFO:scripts.webrtc_driver:Data channel is open [go2_driver_node-3] INFO:scripts.webrtc_driver:-> Sending message {"type": "validation", "topic": "", "data": "FE9lnV0IU4+lcSvEMXr6Rw=="} [go2_driver_node-3] INFO:scripts.webrtc_driver:-> Sending message {"type": "vid", "topic": "", "data": "on"} [go2_driver_node-3] /home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py:133: RuntimeWarning: invalid value encountered in arcsin [go2_driver_node-3] A = -np.pi + np.arcsin(C / E) + y [go2_driver_node-3] /home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py:136: RuntimeWarning: invalid value encountered in arcsin [go2_driver_node-3] L = np.arcsin(R / O) [go2_driver_node-3] /home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py:144: RuntimeWarning: invalid value encountered in arcsin [go2_driver_node-3] J = P * (L - np.arcsin(HIP_LENGTH / O)) [go2_driver_node-3] /home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py:147: RuntimeWarning: invalid value encountered in arcsin [go2_driver_node-3] J = P * (L + np.arcsin(HIP_LENGTH / O)) [go2_driver_node-3] Exception in thread Thread-1 (spin): [go2_driver_node-3] Traceback (most recent call last): [go2_driver_node-3] File "/usr/lib/python3.10/threading.py", line 1016, in _bootstrap_inner [go2_driver_node-3] self.run() [go2_driver_node-3] File "/usr/lib/python3.10/threading.py", line 953, in run [go2_driver_node-3] self._target(*self._args, **self._kwargs) [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 294, in spin [go2_driver_node-3] self.spin_once() [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 751, in spin_once [go2_driver_node-3] self._spin_once_impl(timeout_sec) [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 748, in _spin_once_impl [go2_driver_node-3] raise handler.exception() [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/task.py", line 254, in __call__ [go2_driver_node-3] self._handler.send(None) [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 447, in handler [go2_driver_node-3] await call_coroutine(entity, arg) [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 361, in _execute_timer [go2_driver_node-3] await await_or_execute(tmr.callback) [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 107, in await_or_execute [go2_driver_node-3] return callback(*args) [go2_driver_node-3] File "/home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/python3.10/site-packages/go2_robot_sdk/go2_driver_node.py", line 262, in timer_callback [go2_driver_node-3] self.publish_joint_state_webrtc() [go2_driver_node-3] File "/home/deuser/Desktop/unitree/install/go2_robot_sdk/lib/python3.10/site-packages/go2_robot_sdk/go2_driver_node.py", line 600, in publish_joint_state_webrtc [go2_driver_node-3] joint_state.position = [ [go2_driver_node-3] File "/opt/ros/humble/local/lib/python3.10/dist-packages/sensor_msgs/msg/_joint_state.py", line 203, in position [go2_driver_node-3] assert \ [go2_driver_node-3] AssertionError: The 'position' field must be a set or sequence and each value of type 'float' and each double in [-179769313486231570814527423731704356798070567525844996598917476803157260780028538760589558632766878171540458953514382464234321326889464182768467546703537516986049910576551282076245490090389328944075868508455133942304583236903222948165808559332123348274797826204144723168738177180919299881250404026184124858368.000000, 179769313486231570814527423731704356798070567525844996598917476803157260780028538760589558632766878171540458953514382464234321326889464182768467546703537516986049910576551282076245490090389328944075868508455133942304583236903222948165808559332123348274797826204144723168738177180919299881250404026184124858368.000000] [go2_driver_node-3] [h264 @ 0x7ae568000e40] non-existing PPS 0 referenced [go2_driver_node-3] [h264 @ 0x7ae568000e40] decode_slice_header error [go2_driver_node-3] [h264 @ 0x7ae568000e40] no frame! [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [go2_driver_node-3] [h264 @ 0x7ae568000e40] non-existing PPS 0 referenced [go2_driver_node-3] [h264 @ 0x7ae568000e40] decode_slice_header error [go2_driver_node-3] [h264 @ 0x7ae568000e40] no frame! [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [go2_driver_node-3] [h264 @ 0x7ae568000e40] non-existing PPS 0 referenced [go2_driver_node-3] [h264 @ 0x7ae568000e40] decode_slice_header error [go2_driver_node-3] [h264 @ 0x7ae568000e40] no frame! [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [go2_driver_node-3] [h264 @ 0x7ae568000e40] non-existing PPS 0 referenced [go2_driver_node-3] [h264 @ 0x7ae568000e40] decode_slice_header error [go2_driver_node-3] [h264 @ 0x7ae568000e40] no frame! [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [go2_driver_node-3] [h264 @ 0x7ae568000e40] non-existing PPS 0 referenced [go2_driver_node-3] [h264 @ 0x7ae568000e40] decode_slice_header error [go2_driver_node-3] [h264 @ 0x7ae568000e40] no frame! [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [go2_driver_node-3] [h264 @ 0x7ae568000e40] non-existing PPS 0 referenced [go2_driver_node-3] [h264 @ 0x7ae568000e40] decode_slice_header error [go2_driver_node-3] [h264 @ 0x7ae568000e40] no frame! [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [go2_driver_node-3] [h264 @ 0x7ae568000e40] non-existing PPS 0 referenced [go2_driver_node-3] [h264 @ 0x7ae568000e40] decode_slice_header error [go2_driver_node-3] [h264 @ 0x7ae568000e40] no frame! [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [go2_driver_node-3] INFO:scripts.webrtc_driver:Received frame <av.VideoFrame, pts=420 yuv420p 1280x720 at 0x7ae5942b7b20> [go2_driver_node-3] INFO:go2_robot_sdk.go2_driver_node:Video frame received for robot 0 [lidar_to_pointcloud-4] /opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/node.py:441: UserWarning: when declaring parameter named 'robot_ip_lst', declaring a parameter only providing its name is deprecated. You have to either: [lidar_to_pointcloud-4] - Pass a name and a default value different to "PARAMETER NOT SET" (and optionally a descriptor). [lidar_to_pointcloud-4] - Pass a name and a parameter type. [lidar_to_pointcloud-4] - Pass a name and a descriptor with dynamic_typing=True [lidar_to_pointcloud-4] warnings.warn( [lidar_to_pointcloud-4] /opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/node.py:441: UserWarning: when declaring parameter named ‘map_name’, declaring a parameter only providing its name is deprecated. You have to either: [lidar_to_pointcloud-4] - Pass a name and a default value different to “PARAMETER NOT SET” (and optionally a descriptor). [lidar_to_pointcloud-4] - Pass a name and a parameter type. [lidar_to_pointcloud-4] - Pass a name and a descriptor with dynamic_typing=True [lidar_to_pointcloud-4] warnings.warn( [lidar_to_pointcloud-4] /opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/node.py:441: UserWarning: when declaring parameter named 'map_save', declaring a parameter only providing its name is deprecated. You have to either: [lidar_to_pointcloud-4] - Pass a name and a default value different to "PARAMETER NOT SET" (and optionally a descriptor). [lidar_to_pointcloud-4] - Pass a name and a parameter type. [lidar_to_pointcloud-4] - Pass a name and a descriptor with dynamic_typing=True [lidar_to_pointcloud-4] warnings.warn( [lidar_to_pointcloud-4] [INFO] [1747908261.271400819] [lidar_to_pointcloud]: Map will be saved [lidar_to_pointcloud-4] [INFO] [1747908261.271893246] [lidar_to_pointcloud]: Map name is 3d_map.ply [go2_driver_node-3] [h264 @ 0x7ae568000e40] No start code is found. [go2_driver_node-3] [h264 @ 0x7ae568000e40] Error splitting the input into NAL units. [go2_driver_node-3] WARNING:aiortc.codecs.h264:H264Decoder() failed to decode, skipping package: [Errno 1094995529] Invalid data found when processing input [planner_server-13] [INFO] [1747908277.840175703] [planner_server]: Configured plugin GridBased of type SmacPlannerHybrid with maximum iterations 1000000, max on approach iterations 1000, and not allowing unknown traversal. Tolerance 3.00.Using motion model: Reeds-Shepp. [planner_server-13] [INFO] [1747908277.840243388] [planner_server]: Planner Server has GridBased planners available. [lifecycle_manager-18] [INFO] [1747908277.879574033] [lifecycle_manager_navigation]: Configuring behavior_server
[behavior_server-14] [INFO] [1747908277.880026947] [behavior_server]: Configuring [behavior_server-14] [INFO] [1747908277.904621097] [behavior_server]: Creating behavior plugin spin of type nav2_behaviors/Spin [behavior_server-14] [INFO] [1747908277.905837172] [behavior_server]: Configuring spin [behavior_server-14] [INFO] [1747908277.922519722] [behavior_server]: Creating behavior plugin backup of type nav2_behaviors/BackUp [behavior_server-14] [INFO] [1747908277.924711391] [behavior_server]: Configuring backup [behavior_server-14] [INFO] [1747908277.942631277] [behavior_server]: Creating behavior plugin drive_on_heading of type nav2_behaviors/DriveOnHeading [behavior_server-14] [INFO] [1747908277.944162428] [behavior_server]: Configuring drive_on_heading [behavior_server-14] [INFO] [1747908277.958070730] [behavior_server]: Creating behavior plugin assisted_teleop of type nav2_behaviors/AssistedTeleop [behavior_server-14] [INFO] [1747908277.961839226] [behavior_server]: Configuring assisted_teleop [behavior_server-14] [INFO] [1747908277.980835128] [behavior_server]: Creating behavior plugin wait of type nav2_behaviors/Wait [behavior_server-14] [INFO] [1747908277.981825842] [behavior_server]: Configuring wait [lifecycle_manager-18] [INFO] [1747908277.998534161] [lifecycle_manager_navigation]: Configuring bt_navigator
[bt_navigator-15] [INFO] [1747908278.000599480] [bt_navigator]: Configuring [lifecycle_manager-18] [INFO] [1747908278.198095420] [lifecycle_manager_navigation]: Configuring waypoint_follower
[waypoint_follower-16] [INFO] [1747908278.198404739] [waypoint_follower]: Configuring [waypoint_follower-16] [INFO] [1747908278.234800973] [waypoint_follower]: Created waypoint_task_executor : wait_at_waypoint of type nav2_waypoint_follower::WaitAtWaypoint [lifecycle_manager-18] [INFO] [1747908278.239490834] [lifecycle_manager_navigation]: Configuring velocity_smoother
[velocity_smoother-17] [INFO] [1747908278.240175245] [velocity_smoother]: Configuring velocity smoother [lifecycle_manager-18] [INFO] [1747908278.259251874] [lifecycle_manager_navigation]: Activating controller_server
[controller_server-11] [INFO] [1747908278.259661611] [controller_server]: Activating [controller_server-11] [INFO] [1747908278.259737339] [local_costmap.local_costmap]: Activating [controller_server-11] [INFO] [1747908278.259817071] [local_costmap.local_costmap]: Checking transform [controller_server-11] [INFO] [1747908278.259928051] [local_costmap.local_costmap]: start [controller_server-11] [INFO] [1747908279.264666699] [controller_server]: Creating bond (controller_server) to lifecycle manager. [lifecycle_manager-18] [INFO] [1747908279.380962375] [lifecycle_manager_navigation]: Server controller_server connected with bond. [lifecycle_manager-18] [INFO] [1747908279.381011532] [lifecycle_manager_navigation]: Activating smoother_server
[smoother_server-12] [INFO] [1747908279.381355427] [smoother_server]: Activating [smoother_server-12] [INFO] [1747908279.381405993] [smoother_server]: Creating bond (smoother_server) to lifecycle manager. [lifecycle_manager-18] [INFO] [1747908279.492681217] [lifecycle_manager_navigation]: Server smoother_server connected with bond. [lifecycle_manager-18] [INFO] [1747908279.492727305] [lifecycle_manager_navigation]: Activating planner_server
[planner_server-13] [INFO] [1747908279.493039276] [planner_server]: Activating [planner_server-13] [INFO] [1747908279.493083264] [global_costmap.global_costmap]: Activating [planner_server-13] [INFO] [1747908279.493106998] [global_costmap.global_costmap]: Checking transform [planner_server-13] [INFO] [1747908279.493210825] [global_costmap.global_costmap]: start [planner_server-13] [INFO] [1747908281.348221568] [planner_server]: Activating plugin GridBased of type SmacPlannerHybrid [planner_server-13] [INFO] [1747908281.356394212] [planner_server]: Creating bond (planner_server) to lifecycle manager. [lifecycle_manager-18] [INFO] [1747908281.473836723] [lifecycle_manager_navigation]: Server planner_server connected with bond. [lifecycle_manager-18] [INFO] [1747908281.473891377] [lifecycle_manager_navigation]: Activating behavior_server
[behavior_server-14] [INFO] [1747908281.474308494] [behavior_server]: Activating [behavior_server-14] [INFO] [1747908281.474340258] [behavior_server]: Activating spin [behavior_server-14] [INFO] [1747908281.474356137] [behavior_server]: Activating backup [behavior_server-14] [INFO] [1747908281.474368080] [behavior_server]: Activating drive_on_heading [behavior_server-14] [INFO] [1747908281.474378628] [behavior_server]: Activating assisted_teleop [behavior_server-14] [INFO] [1747908281.474388303] [behavior_server]: Activating wait [behavior_server-14] [INFO] [1747908281.474402645] [behavior_server]: Creating bond (behavior_server) to lifecycle manager. [lifecycle_manager-18] [INFO] [1747908281.596541242] [lifecycle_manager_navigation]: Server behavior_server connected with bond. [lifecycle_manager-18] [INFO] [1747908281.596679561] [lifecycle_manager_navigation]: Activating bt_navigator
[bt_navigator-15] [INFO] [1747908281.598078805] [bt_navigator]: Activating [bt_navigator-15] [INFO] [1747908281.942123870] [bt_navigator]: Creating bond (bt_navigator) to lifecycle manager. [lifecycle_manager-18] [INFO] [1747908282.058922686] [lifecycle_manager_navigation]: Server bt_navigator connected with bond. [lifecycle_manager-18] [INFO] [1747908282.058975657] [lifecycle_manager_navigation]: Activating waypoint_follower
[waypoint_follower-16] [INFO] [1747908282.060447317] [waypoint_follower]: Activating [waypoint_follower-16] [INFO] [1747908282.060501834] [waypoint_follower]: Creating bond (waypoint_follower) to lifecycle manager. [lifecycle_manager-18] [INFO] [1747908282.179805945] [lifecycle_manager_navigation]: Server waypoint_follower connected with bond. [lifecycle_manager-18] [INFO] [1747908282.179866261] [lifecycle_manager_navigation]: Activating velocity_smoother
[velocity_smoother-17] [INFO] [1747908282.182821593] [velocity_smoother]: Activating [velocity_smoother-17] [INFO] [1747908282.182962131] [velocity_smoother]: Creating bond (velocity_smoother) to lifecycle manager. [lifecycle_manager-18] [INFO] [1747908282.303326168] [lifecycle_manager_navigation]: Server velocity_smoother connected with bond. [lifecycle_manager-18] [INFO] [1747908282.303409399] [lifecycle_manager_navigation]: Managed nodes are active
[lifecycle_manager-18] [INFO] [1747908282.303427373] [lifecycle_manager_navigation]: Creating bond timer…
[controller_server-11] [WARN] [1747908288.260838196] [local_costmap.local_costmap]: Can’t update static costmap layer, no map received [planner_server-13] [WARN] [1747908289.862658794] [global_costmap.global_costmap]: Can’t update static costmap layer, no map received `

Hi every one for this issue I see it’s realated to tf and in the log I see the issue and try to solve it the log said

[go2_driver_node-3] /home/ammar/go2_ros2_ws/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py:133: RuntimeWarning: invalid value encountered in arcsin
[go2_driver_node-3]   A = -np.pi + np.arcsin(C / E) + y
[go2_driver_node-3] /home/ammar/go2_ros2_ws/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py:136: RuntimeWarning: invalid value encountered in arcsin
[go2_driver_node-3]   L = np.arcsin(R / O)
[go2_driver_node-3] /home/ammar/go2_ros2_ws/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py:144: RuntimeWarning: invalid value encountered in arcsin
[go2_driver_node-3]   J = P * (L - np.arcsin(HIP_LENGTH / O))
[go2_driver_node-3] /home/ammar/go2_ros2_ws/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py:147: RuntimeWarning: invalid value encountered in arcsin
[go2_driver_node-3]   J = P * (L + np.arcsin(HIP_LENGTH / O))
[go2_driver_node-3] Exception in thread Thread-1 (spin):
[go2_driver_node-3] Traceback (most recent call last):
[go2_driver_node-3]   File "/usr/lib/python3.10/threading.py", line 1016, in _bootstrap_inner
[go2_driver_node-3]     self.run()
[go2_driver_node-3]   File "/usr/lib/python3.10/threading.py", line 953, in run
[go2_driver_node-3]     self._target(*self._args, **self._kwargs)
[go2_driver_node-3]   File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 294, in spin
[go2_driver_node-3]     self.spin_once()
[go2_driver_node-3]   File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 751, in spin_once
[go2_driver_node-3]     self._spin_once_impl(timeout_sec)
[go2_driver_node-3]   File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 748, in _spin_once_impl
[go2_driver_node-3]     raise handler.exception()
[go2_driver_node-3]   File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/task.py", line 254, in __call__
[go2_driver_node-3]     self._handler.send(None)
[go2_driver_node-3]   File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 447, in handler
[go2_driver_node-3]     await call_coroutine(entity, arg)
[go2_driver_node-3]   File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 361, in _execute_timer
[go2_driver_node-3]     await await_or_execute(tmr.callback)
[go2_driver_node-3]   File "/opt/ros/humble/local/lib/python3.10/dist-packages/rclpy/executors.py", line 107, in await_or_execute
[go2_driver_node-3]     return callback(*args)
[go2_driver_node-3]   File "/home/ammar/go2_ros2_ws/install/go2_robot_sdk/lib/python3.10/site-packages/go2_robot_sdk/go2_driver_node.py", line 262, in timer_callback
[go2_driver_node-3]     self.publish_joint_state_webrtc()
[go2_driver_node-3]   File "/home/ammar/go2_ros2_ws/install/go2_robot_sdk/lib/python3.10/site-packages/go2_robot_sdk/go2_driver_node.py", line 600, in publish_joint_state_webrtc
[go2_driver_node-3]     joint_state.position = [
[go2_driver_node-3]   File "/opt/ros/humble/local/lib/python3.10/dist-packages/sensor_msgs/msg/_joint_state.py", line 203, in position
[go2_driver_node-3]     assert \
[go2_driver_node-3] AssertionError: The 'position' field must be a set or sequence and each value of type 'float' and each double in [-179769313486231570814527423731704356798070567525844996598917476803157260780028538760589558632766878171540458953514382464234321326889464182768467546703537516986049910576551282076245490090389328944075868508455133942304583236903222948165808559332123348274797826204144723168738177180919299881250404026184124858368.000000, 179769313486231570814527423731704356798070567525844996598917476803157260780028538760589558632766878171540458953514382464234321326889464182768467546703537516986049910576551282076245490090389328944075868508455133942304583236903222948165808559332123348274797826204144723168738177180919299881250404026184124858368.000000]
  

So the issue is related to

The error you’re seeing, RuntimeWarning: invalid value encountered in arcsin, is the root cause of the entire crash.

The np.arcsin() (or sin⁻¹) function in NumPy is only defined for input values in the range of [-1.0, 1.0]. Due to floating-point inaccuracies or the robot’s leg reaching a singularity (a position where it’s fully stretched or in an impossible configuration), the calculations in your go2_math.py script are producing values slightly outside this range (e.g., 1.0000001 or -1.0000001).

When np.arcsin() receives an invalid value, it returns NaN (Not a Number). These NaN values propagate through your calculations, and when you try to assign them to the position field of the ROS 2 JointState message, it fails with an AssertionError because NaN is not a valid floating-point number for that message type.

The Solution

To fix this, you must “clip” or “clamp” the input to every np.arcsin() call to ensure it stays within the valid [-1.0, 1.0] range. You can do this using the np.clip() function.

  1. Open the file: Navigate to and open the script that is causing the error:
  • /home/ammar/go2_ros2_ws/install/go2_robot_sdk/lib/python3.10/site-packages/scripts/go2_math.py
  1. Modify the problematic lines: You need to wrap the arguments of the np.arcsin calls with np.clip(argument, -1.0, 1.0).

    Line 133: Original: Python

    A = -np.pi + np.arcsin(C / E) + y
    

    Corrected: Python

    A = -np.pi + np.arcsin(np.clip(C / E, -1.0, 1.0)) + y
    

    Line 136:

    Original: Python

    L = np.arcsin(R / O)
    

    Corrected: Python

     L = np.arcsin(np.clip(R / O, -1.0, 1.0))
    

    Line 144:

    Original: Python

    J = P * (L - np.arcsin(HIP_LENGTH / O))
    

    Corrected: Python

    J = P * (L - np.arcsin(np.clip(HIP_LENGTH / O, -1.0, 1.0)))
    

    Line 147:

    Original: Python

    J = P * (L + np.arcsin(HIP_LENGTH / O))
    

    Corrected: Python

    J = P * (L + np.arcsin(np.clip(HIP_LENGTH / O, -1.0, 1.0)))
    
  2. Rebuild your ROS 2 Workspace: After saving the changes to go2_math.py, navigate back to the root of your workspace (~/go2_ros2_ws) and rebuild it to apply the changes. Bash

cd ~/go2_ros2_ws
colcon build
  1. Source and Relaunch: Finally, source your workspace and relaunch your driver node. The error should now be resolved. Bash
source install/setup.bash
# Your ros2 launch command here

Image

Image

Now every stuff is working but the tf preview It having issue I will try to find the issue related to it

Note: The AI help me to type the correct script

i also meet the same problem,ubuntu22.04humble version

Image