babahadjsaid / elevation_mapping

1 stars 0 forks source link

Testing with turtlebot3 environment #2

Closed Muhammad540 closed 2 days ago

Muhammad540 commented 5 days ago

First of all, thank you for the great work in porting this to Humble. I was in the process of porting it myself when I found your repository. I am testing the elevation mapping using the TurtleBot3 environment. The TurtleBot3 publishes point cloud data and the robot pose on the /cloud/points and /robot_state/pose topics, respectively. I successfully built your package. After modifying the ground_truth_demo yaml, i was successfully able to provide the relevant topic to the elevation mapping node, but i am experiencing the following error, [elevation_mapping-1] [ERROR] [1719990711.628701039] [elevation_mapping]: Could not get pose information from robot for time 2613.695000. Buffer empty? Here is the rqt graph: image

babahadjsaid commented 5 days ago

Hello, so i think the problem is either the pose of the robot is not published, or there is a problem on the time of the pose being published, mybe the time is old. you need to check this in rqt /pose_publisher topic ( according to the rqt_graph you sent), also can you check weather the published pose is of type nav_msgs::msg::Odometry.

Muhammad540 commented 5 days ago

Thank you so much for your prompt response. Your advice helped me resolve the buffer empty error. I checked the pose and timestamps, and they were correct. When I switched to publishing the robot pose using _navmsgs/msg/Odometry instead of _geometrymsgs/PoseWithCovarianceStamped, the error was resolved.

Now, although the mapping process seems to have started without errors, I still don't see any elevation map in RViz. The output of the _/elevationmap topic is showing NaN values. Here is the command line output after the elevation node starts:

image

And here is the output of the /elevation_map topic: image It seems that the variance is too high, which might be causing the NaN values. Did you experience such an issue? Maybe we need to tweak some parameters. I would be really grateful if you could help me understand how to address this problem. Also i suspected maybe this a transform issue, here is the transform tree: image. I am just speculating, maybe it is something else. Also this is the ground_truth_demo.yaml file image

babahadjsaid commented 4 days ago

I just saw your question, did you solve it or not yet ?

Muhammad540 commented 3 days ago

Yes, i was able to publish the elevation map, and the reason for NaN values was high variance so i reduced it. However, the elevation mapping is very slow, the map updates take alot of time. It is hard to see it working in real time in current situation, did you face the same issue ? I am thinking of using some point cloud filtering approaches.

babahadjsaid commented 3 days ago

for me i ended up developing my own approach because the package didn't meet my requirments, so i didn't really use it much. :/ concerning your approach depending on the problem you are trying to solve.