Open UdayRockzz opened 2 years ago
Hello @UdayRockzz
I'd start by checking things like:
rosnode info /rtabmap
# check what topics is rtabmap subscribing to
If the topics you expect to have are there (e.g. rgb and depth camera), check that they have a camera_info topic associated to it. Without it, I think it won't work (or so I recall).
I do not know where the source of your ROS images is (e.g. running your robot? running from a bridge in your computer?), but if it is in the robot, you may need to synchronize the clock of your system and the robot's system to avoid timestamp issues.
I also would recommend you to start with a rosbag with the topics you need from the robot, and then try to run rtabmap with that rosbag until you get something working.
Additionally, having a rosbag, you can post it here (or probably in ROS answers, which I'm pretty sure would be a better place to post this question) so people can help you better. Without data, it's hard to help.
Good luck!
Thanks for the reply @awesomebytes. Iam Using nao python based SDK to connect bridge between ros and pepper robot. and then these are the topics I have used. it was there in the code which I have sent to you in email. but I dont know how those are missed here. and I will start working with rosbags.
Showing the launchfile is not the same than checking what the node is subscribed to
well, I got it. this is rqt_graph and below are the topics list.
/clicked_point /cmd_vel /diagnostics /initialpose /joint_angles /joint_states /map /move_base_simple/goal /pepper_robot/audio /pepper_robot/bumper /pepper_robot/camera/bottom/camera_info /pepper_robot/camera/bottom/image_raw /pepper_robot/camera/bottom/image_raw/compressed /pepper_robot/camera/bottom/image_raw/compressed/parameter_descriptions /pepper_robot/camera/bottom/image_raw/compressed/parameter_updates /pepper_robot/camera/bottom/image_raw/theora /pepper_robot/camera/bottom/image_raw/theora/parameter_descriptions /pepper_robot/camera/bottom/image_raw/theora/parameter_updates /pepper_robot/camera/bottom/image_rect_color /pepper_robot/camera/bottom/image_rect_color/compressed /pepper_robot/camera/bottom/image_rect_color/compressed/parameter_descriptions /pepper_robot/camera/bottom/image_rect_color/compressed/parameter_updates /pepper_robot/camera/bottom/image_rect_color/compressedDepth /pepper_robot/camera/bottom/image_rect_color/compressedDepth/parameter_descriptions /pepper_robot/camera/bottom/image_rect_color/compressedDepth/parameter_updates /pepper_robot/camera/bottom/image_rect_color/theora /pepper_robot/camera/bottom/image_rect_color/theora/parameter_descriptions /pepper_robot/camera/bottom/image_rect_color/theora/parameter_updates /pepper_robot/camera/bottom_rectify_color/parameter_descriptions /pepper_robot/camera/bottom_rectify_color/parameter_updates /pepper_robot/camera/depth/camera_info /pepper_robot/camera/depth/image /pepper_robot/camera/depth/image/compressed /pepper_robot/camera/depth/image/compressed/parameter_descriptions /pepper_robot/camera/depth/image/compressed/parameter_updates /pepper_robot/camera/depth/image/compressedDepth /pepper_robot/camera/depth/image/compressedDepth/parameter_descriptions /pepper_robot/camera/depth/image/compressedDepth/parameter_updates /pepper_robot/camera/depth/image/theora /pepper_robot/camera/depth/image/theora/parameter_descriptions /pepper_robot/camera/depth/image/theora/parameter_updates /pepper_robot/camera/depth/image_raw /pepper_robot/camera/depth/image_raw/compressed /pepper_robot/camera/depth/image_raw/compressed/parameter_descriptions /pepper_robot/camera/depth/image_raw/compressed/parameter_updates /pepper_robot/camera/depth/image_raw/compressedDepth /pepper_robot/camera/depth/image_raw/compressedDepth/parameter_descriptions /pepper_robot/camera/depth/image_raw/compressedDepth/parameter_updates /pepper_robot/camera/depth/image_raw/theora /pepper_robot/camera/depth/image_raw/theora/parameter_descriptions /pepper_robot/camera/depth/image_raw/theora/parameter_updates /pepper_robot/camera/depth/image_rect /pepper_robot/camera/depth/image_rect/compressed /pepper_robot/camera/depth/image_rect/compressed/parameter_descriptions /pepper_robot/camera/depth/image_rect/compressed/parameter_updates /pepper_robot/camera/depth/image_rect/compressedDepth /pepper_robot/camera/depth/image_rect/compressedDepth/parameter_descriptions /pepper_robot/camera/depth/image_rect/compressedDepth/parameter_updates /pepper_robot/camera/depth/image_rect/theora /pepper_robot/camera/depth/image_rect/theora/parameter_descriptions /pepper_robot/camera/depth/image_rect/theora/parameter_updates /pepper_robot/camera/depth/image_rect_raw /pepper_robot/camera/depth/image_rect_raw/compressed /pepper_robot/camera/depth/image_rect_raw/compressed/parameter_descriptions /pepper_robot/camera/depth/image_rect_raw/compressed/parameter_updates /pepper_robot/camera/depth/image_rect_raw/compressedDepth /pepper_robot/camera/depth/image_rect_raw/compressedDepth/parameter_descriptions /pepper_robot/camera/depth/image_rect_raw/compressedDepth/parameter_updates /pepper_robot/camera/depth/image_rect_raw/theora /pepper_robot/camera/depth/image_rect_raw/theora/parameter_descriptions /pepper_robot/camera/depth/image_rect_raw/theora/parameter_updates /pepper_robot/camera/depth_rectify_depth/parameter_descriptions /pepper_robot/camera/depth_rectify_depth/parameter_updates /pepper_robot/camera/depth_registered/camera_info /pepper_robot/camera/depth_registered/hw_registered/image_rect /pepper_robot/camera/depth_registered/hw_registered/image_rect/compressed /pepper_robot/camera/depth_registered/hw_registered/image_rect/compressed/parameter_descriptions /pepper_robot/camera/depth_registered/hw_registered/image_rect/compressed/parameter_updates /pepper_robot/camera/depth_registered/hw_registered/image_rect/compressedDepth /pepper_robot/camera/depth_registered/hw_registered/image_rect/compressedDepth/parameter_descriptions /pepper_robot/camera/depth_registered/hw_registered/image_rect/compressedDepth/parameter_updates /pepper_robot/camera/depth_registered/hw_registered/image_rect/theora /pepper_robot/camera/depth_registered/hw_registered/image_rect/theora/parameter_descriptions /pepper_robot/camera/depth_registered/hw_registered/image_rect/theora/parameter_updates /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/compressed /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/compressed/parameter_descriptions /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/compressed/parameter_updates /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/compressedDepth /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/compressedDepth/parameter_descriptions /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/compressedDepth/parameter_updates /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/theora /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/theora/parameter_descriptions /pepper_robot/camera/depth_registered/hw_registered/image_rect_raw/theora/parameter_updates /pepper_robot/camera/depth_registered/image /pepper_robot/camera/depth_registered/image/compressed /pepper_robot/camera/depth_registered/image/compressed/parameter_descriptions /pepper_robot/camera/depth_registered/image/compressed/parameter_updates /pepper_robot/camera/depth_registered/image/compressedDepth /pepper_robot/camera/depth_registered/image/compressedDepth/parameter_descriptions /pepper_robot/camera/depth_registered/image/compressedDepth/parameter_updates /pepper_robot/camera/depth_registered/image/theora /pepper_robot/camera/depth_registered/image/theora/parameter_descriptions /pepper_robot/camera/depth_registered/image/theora/parameter_updates /pepper_robot/camera/depth_registered/image_raw /pepper_robot/camera/depth_registered/points /pepper_robot/camera/depth_registered/sw_registered/camera_info /pepper_robot/camera/depth_registered/sw_registered/image_rect /pepper_robot/camera/depth_registered/sw_registered/image_rect/compressed /pepper_robot/camera/depth_registered/sw_registered/image_rect/compressed/parameter_descriptions /pepper_robot/camera/depth_registered/sw_registered/image_rect/compressed/parameter_updates /pepper_robot/camera/depth_registered/sw_registered/image_rect/compressedDepth /pepper_robot/camera/depth_registered/sw_registered/image_rect/compressedDepth/parameter_descriptions /pepper_robot/camera/depth_registered/sw_registered/image_rect/compressedDepth/parameter_updates /pepper_robot/camera/depth_registered/sw_registered/image_rect/theora /pepper_robot/camera/depth_registered/sw_registered/image_rect/theora/parameter_descriptions /pepper_robot/camera/depth_registered/sw_registered/image_rect/theora/parameter_updates /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/compressed /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/compressed/parameter_descriptions /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/compressed/parameter_updates /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/compressedDepth /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/compressedDepth/parameter_descriptions /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/compressedDepth/parameter_updates /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/theora /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/theora/parameter_descriptions /pepper_robot/camera/depth_registered/sw_registered/image_rect_raw/theora/parameter_updates /pepper_robot/camera/depth_registered_rectify_depth/parameter_descriptions /pepper_robot/camera/depth_registered_rectify_depth/parameter_updates /pepper_robot/camera/front/camera_info /pepper_robot/camera/front/image_raw /pepper_robot/camera/front/image_raw/compressed /pepper_robot/camera/front/image_raw/compressed/parameter_descriptions /pepper_robot/camera/front/image_raw/compressed/parameter_updates /pepper_robot/camera/front/image_raw/theora /pepper_robot/camera/front/image_raw/theora/parameter_descriptions /pepper_robot/camera/front/image_raw/theora/parameter_updates /pepper_robot/camera/front/image_rect_color /pepper_robot/camera/front/image_rect_color/compressed /pepper_robot/camera/front/image_rect_color/compressed/parameter_descriptions /pepper_robot/camera/front/image_rect_color/compressed/parameter_updates /pepper_robot/camera/front/image_rect_color/compressedDepth /pepper_robot/camera/front/image_rect_color/compressedDepth/parameter_descriptions /pepper_robot/camera/front/image_rect_color/compressedDepth/parameter_updates /pepper_robot/camera/front/image_rect_color/theora /pepper_robot/camera/front/image_rect_color/theora/parameter_descriptions /pepper_robot/camera/front/image_rect_color/theora/parameter_updates /pepper_robot/camera/front_rectify_color/parameter_descriptions /pepper_robot/camera/front_rectify_color/parameter_updates /pepper_robot/camera/ir/image_rect_ir /pepper_robot/camera/ir/image_rect_ir/compressed /pepper_robot/camera/ir/image_rect_ir/compressed/parameter_descriptions /pepper_robot/camera/ir/image_rect_ir/compressed/parameter_updates /pepper_robot/camera/ir/image_rect_ir/compressedDepth /pepper_robot/camera/ir/image_rect_ir/compressedDepth/parameter_descriptions /pepper_robot/camera/ir/image_rect_ir/compressedDepth/parameter_updates /pepper_robot/camera/ir/image_rect_ir/theora /pepper_robot/camera/ir/image_rect_ir/theora/parameter_descriptions /pepper_robot/camera/ir/image_rect_ir/theora/parameter_updates /pepper_robot/camera/ir_rectify_ir/parameter_descriptions /pepper_robot/camera/ir_rectify_ir/parameter_updates /pepper_robot/camera/stereo/camera_info /pepper_robot/camera/stereo/image_raw /pepper_robot/camera/stereo/image_raw/compressed /pepper_robot/camera/stereo/image_raw/compressed/parameter_descriptions /pepper_robot/camera/stereo/image_raw/compressed/parameter_updates /pepper_robot/camera/stereo/image_raw/theora /pepper_robot/camera/stereo/image_raw/theora/parameter_descriptions /pepper_robot/camera/stereo/image_raw/theora/parameter_updates /pepper_robot/hand_touch /pepper_robot/head_touch /pepper_robot/imu/base /pepper_robot/imu/torso /pepper_robot/info /pepper_robot/laser /pepper_robot/odom /pepper_robot/sonar/back /pepper_robot/sonar/front /rosout /rosout_agg /rtabmap/cloud_ground /rtabmap/cloud_map /rtabmap/cloud_obstacles /rtabmap/global_path /rtabmap/global_path_nodes /rtabmap/global_pose /rtabmap/goal /rtabmap/goal_node /rtabmap/goal_out /rtabmap/goal_reached /rtabmap/gps/fix /rtabmap/grid_map /rtabmap/grid_map_updates /rtabmap/grid_prob_map /rtabmap/imu /rtabmap/info /rtabmap/initialpose /rtabmap/labels /rtabmap/landmarks /rtabmap/local_grid_empty /rtabmap/local_grid_ground /rtabmap/local_grid_obstacle /rtabmap/local_path /rtabmap/local_path_nodes /rtabmap/localization_pose /rtabmap/mapData /rtabmap/mapGraph /rtabmap/mapPath /rtabmap/octomap_binary /rtabmap/octomap_empty_space /rtabmap/octomap_full /rtabmap/octomap_global_frontier_space /rtabmap/octomap_grid /rtabmap/octomap_ground /rtabmap/octomap_obstacles /rtabmap/octomap_occupied_space /rtabmap/odom /rtabmap/proj_map /rtabmap/rgb/camera_info /rtabmap/rgb/image /rtabmap/rgbd_image /rtabmap/rgbd_image/compressed /rtabmap/scan_map /rtabmap/user_data_async /speech /statistics /tf /tf_static
I checked with rosbag for all the topics. here are the recorded messages
also, Here are the results when I run rostopic hz
for both front camera and depth topics.
and finally. rviz image
You still haven't shared the rosnode info command.
These are the list of nodes after launching the launch file,. .
so I have checked nodes with /rtabmap/rtabmap. and here is the list for that.
and here is the node info for /rtabmap/rgbd_sync
@UdayRockzz you can see that rtabmap is not subscribed to any existing image topic. You'll need to remap that correctly (using or not using rgbd sync, i don't think you need it, but up to you). Search in the ROS wiki how to remap topics on launchfiles. Also, you seem to want to use the front (top) camera but forwarding the bottom camera camera_info, that also looks wrong to me.
If you try to follow the errors and carefully check the input and outputs of the nodes you should be able to make it work. You can also check the source code of rtabmap if you still don't know what's going on, a good starting point is to search for the prints of errors/warnings you are seeing.
This is probably your first time using ROS. I would recommend you to take a look again at the ROS tutorials, try to use some tutorial with a simulated robot, and maybe borrow a friend to walk you through how to debug some ROS node.
Good luck! I hope you make good progress soon!
Thanks alot for your inputs @awesomebytes. I can slove this issue with correct remaps. And I am testing with bottom camera, so I used bottom camera at that time. and I have another question. Did you use laser sensor for generating map with rtabmap? if so, have you faced any similar kind of issues? and the laser scan works fine when I use with slam_gmapping, but not working with rtabmap.
I did not use laser scans, I used just rgb + depth/pointcloud.
I am having perfect input connection,I could see the echo but it throws me error ,time difference between RGB and depth less than 0.01 ,which I have no idea about it ,since rgbdsync will combine and publish at constant rate ,my configuration is d435+laser+odom
it throws me error
What error?
Hello Everyone,
I am working on pepper robot with Rtabmap. pepper robot has an xtion 3D camera and two RGB cameras, but I am taking data from only one camera. I have written the code as below.