abizovnuralem / go2_ros2_sdk

Unofficial ROS2 SDK support for Unitree GO2 AIR/PRO/EDU
BSD 2-Clause "Simplified" License
152 stars 26 forks source link

Odom/Odom TF Jumping #28

Closed David9696 closed 1 month ago

David9696 commented 2 months ago

Hi,

When I started the driver launch file(ros2 launch go2_robot_sdk robot.launch.py), I can see the full robot model and pointcloud.

However, the robot model is jumping or shifting in rviz. When I check the tf, it seems that the odom tf is jumping.

2 1

As shown in the pictures above, robot pose is changing in alternate in these two positions.

Do you know what is the issue?

Thanks.

David

abizovnuralem commented 2 months ago

Hello, it seems to me that you have two sdk running on the same time? Have you installed official SDK? you need to spilt them on the network.

David9696 commented 2 months ago

Hi,

Thanks for your reply.

How to check whether 2 sdk are running? I didn't install any official sdk.

How to split them on the network?

Thanks.

abizovnuralem commented 2 months ago
  1. you can check ros2 topic list, before executing it. it should be empty.
  2. Are you using wifi for it? Ethernet is not supported (it will be in near future, or you can make a pr)
  3. Wifi should have a strong signal and should be a 6 generation.
David9696 commented 2 months ago

Hi Kindly refer to my inline reply:

  1. Can you can check ros2 topic list, before executing it. it should be empty.

This is the output:

/parameter_events /rosout

But I think is not relevant.

  1. Are you using wifi for it? Ethernet is not supported (it will be in near future, or you can make a pr)

Yes. I am using wifi not ethernet.

  1. Wifi should have a strong signal and should be a 6 generation.

I think mine is 5 gen.

So the problem is network latency?

The odom is publishing at about 7 hz. The point cloud is publishing at about 1 hz.

Also, I have this error:

[pointcloud_to_laserscan_node-8] [INFO] [1715915621.065207353] [pointcloud_to_laserscan]: Message Filter dropping message: frame 'odom' at time 1715915620.897 for reason 'Unknown' [pointcloud_to_laserscan_node-8] terminate called after throwing an instance of 'tf2::ExtrapolationException' [pointcloud_to_laserscan_node-8] what(): Lookup would require extrapolation into the past. Requested time 1715915636.889700 but the earliest data is at time 1715915637.066664, when looking up transform from frame [odom] to frame [radar] [ERROR] [pointcloud_to_laserscan_node-8]: process has died [pid 31767, exit code -6, cmd '/opt/ros/humble/lib/pointcloud_to_laserscan/pointcloud_to_laserscan_node --ros-args -r __node:=pointcloud_to_laserscan --params-file /tmp/launch_params_uc6lkbvt -r cloud_in:=/point_cloud2'].

Is it mean that my wifi connection is too slow?

abizovnuralem commented 2 months ago

It can cause this issue, I don't see other problems

abizovnuralem commented 2 months ago

can you investigate the topics info? from ros echo command and see what is going on there

David9696 commented 1 month ago

Hi,

Just to update. Everything is working fine after i reinstall ubuntu and ros2. Would close this issue.

Thanks.