subscribe to 4 different topics with 2 asus xtions callback error

asked 2014-07-22 15:12:37 -0500

lukashernandez
16 ●2 ●2 ●3

updated 2014-07-22 15:32:33 -0500

Hello everyone,

I have 2 asus xtions and want to subscribe to both of the depth and rgb topics. But the callback of all 4 topics in my program never gets called. The problem only occurs when I subscribe to 4 different topics. Subscribing let's say twice the same depth topic works fine. I checked the topics in rviz and they are all correct. This is the code where I register the callback

message_filters::Subscriber<sensor_msgs::Image> depthSub1(nh, "/camera1/depth/image", 1);
message_filters::Subscriber<sensor_msgs::Image> colorSub1(nh, "/camera1/rgb/image_color", 1);
message_filters::Subscriber<sensor_msgs::Image> depthSub2(nh, "/camera2/depth/image", 1);
message_filters::Subscriber<sensor_msgs::Image> colorSub2(nh, "/camera2/rgb/image_color", 1);
message_filters::Synchronizer<SyncPolicy> sync(SyncPolicy(10), depthSub1, colorSub1,depthSub2, colorSub2);

sync.registerCallback(boost::bind(&PointCloudCalibration::callbackCombi, this, _1, _2, _3, _4));

SyncPolicy is defined as:

typedef message_filters::sync_policies::ApproximateTime<sensor_msgs::Image, sensor_msgs::Image,sensor_msgs::Image, sensor_msgs::Image > SyncPolicy;

When I change depthSub2 "/camera2/depth/image" to "/camera1/depth/image" it works. It appears to me like if it would not be possible to subscribe to 4 different topics.

How can I fix that and what might be the reason?

Thanks in advance!

edit retag flag offensive close merge delete

add a comment

2 Answers

Sort by » oldest newest most voted

answered 2014-07-26 08:54:09 -0500

lukashernandez
16 ●2 ●2 ●3

Finally I know what the problem was, thanks for your help, because it made me realize that the frequency was too low. I used 2 USB 2.0 interfaces because the xtion didn't work with USB 3.0. But for USB 2.0 the bandwidth was too high, so I updated the cameras firmware and now they work with USB 3.0 and my problems are gone :)

edit flag offensive delete link

add a comment

answered 2014-07-22 19:21:37 -0500

demmeln
4306 ●32 ●45 ●69

Have you confirmed your camera2 is being published correctly? Does it work if you subscribe to 4 topics from camera2? Have you confirmed that the timestamps from camera1 and camera2 are properly synced, i.e. reasonably close in comparison to the queue size and frame rate? What happens when you dramatically increase the queue size from 10 to say 10000?

edit flag offensive delete link

Comments

It makes no difference if I subsribe to camera 1 or 2 and in rviz both are displayed correctly, they also have the same frame rate (30 hz). Increasing the queue didn't help either. How can I check the timestamps? I didn't find the command to do so. Thanks for your help!

lukashernandez ( 2014-07-23 10:20:02 -0500 )edit

`rostopic echo /camera1/depth/image/header/stamp` in one terminal and `rostopic echo /camera2/depth/image/header/stamp` in another to view side by side

demmeln ( 2014-07-23 10:37:51 -0500 )edit

Ok I checked that, the weird thing is that when i subscribe to both the rgb and the depth topics of camera1, very few messages are send out. secs: 1406138337 nsecs: 431660880 --- secs: 1406138338 nsecs: 100028746 for camera 2 It was secs: 1406138339 nsecs: 428893245 --- secs: 1406138339 nsecs: 462437619

lukashernandez ( 2014-07-23 11:03:38 -0500 )edit

so it seems like my program slows down the publishing rate when it subscribes to both rgb and depth??

lukashernandez ( 2014-07-23 11:05:39 -0500 )edit

I checked it with rostopic hz /camera1/depth/image when my program was running and average rate: 3.790

lukashernandez ( 2014-07-23 11:12:53 -0500 )edit

This is probably part of the problem. Does your callback every get invoked if you increase the queue size of the Synchronizer?

demmeln ( 2014-07-23 13:46:35 -0500 )edit

Also, try to add callbacks to the 4 indiviual message_filters::Subscriber at the same time as the combined callback and in each individual callback print the timestamp of the arriving message to help debugging.

demmeln ( 2014-07-23 18:51:32 -0500 )edit

Also increase the tolerance for how close all the messages need to be for a match. http://wiki.ros.org/message_filters/ApproximateTime documents several parameters.

tfoote ( 2014-07-24 12:40:01 -0500 )edit

add a comment

subscribe to 4 different topics with 2 asus xtions callback error

2 Answers

Comments

Question Tools

Stats

Related questions

subscribe to 4 different topics with 2 asus xtions callback error edit

2 Answers

Comments

Question Tools

Stats

Related questions

subscribe to 4 different topics with 2 asus xtions callback error