订阅、回调队列与Spinner
订阅是roscpp里最容易踩坑的部分,因为它把"消息到达"和"回调执行"彻底拆开了:字节到达是poll线程干的,回调执行是spin线程干的,中间隔着一个CallbackQueue。
这条流水线想明白了,"回调不执行""回调乱序""一个回调把整个节点卡住"这几类问题基本就都能解释。
subscribe这一步
NodeHandle::subscribe也是模板函数,生成两样东西:
- SubscribeOptions,话题名、队列长度、md5sum、datatype这些
- SubscriptionCallbackHelperT,一个类型擦除的辅助对象,把"怎么从字节反序列化成M、再调用户回调"这段跟类型相关的逻辑包起来,让下层只操作基类指针
这是roscpp处理"上层是模板、下层 得是运行时多态"的常规手法。整条订阅链路里只有这个helper知道消息的真实类型。
接着TopicManager::subscribe:
- 解析话题名
- 找有没有同话题的Subscription,有就把新回调挂上去,没有才新建。所以同一进程订阅同一话题多次,只有一条网络连接
- 调master的registerSubscriber,返回值是当前该话题所有发布者的URI列表
- 把列表交给
Subscription::pubUpdate,由它去逐个协商连接
之后master发现发布者集合变了,会通过从节点的publisherUpdate接口推新列表过来,同样进pubUpdate。所以pubUpdate是订阅方感知拓扑变化的唯一入口。
反序列化被推迟了
消息字节到齐之后Subscription::handleMessage被调用,它干的事挺有意思:对每个已注册的回调创建一个MessageDeserializer压进SubscriptionQueue,然后把这个队列本身当成一个CallbackInterface,投递到对应的CallbackQueue。
// 简化示意,表达关系而非原文
for (auto& info : callbacks_) {
auto deserializer = std::make_shared<MessageDeserializer>(
info->helper_, serialized_msg, connection_header);
info->subscription_queue_->push(info->helper_, deserializer, ...);
info->callback_queue_->addCallback(info->subscription_queue_, info->id_);
}
两个点值得记:
一是反序列化被推到SubscriptionQueue::call里执行,也就是在spin线程里,不在网络线程里,这样poll线程能保持轻量。
二是同一个md5sum的多个回调共享同一次反序列化结果。一个进程里对同一话题注册5个相同类型的回调,消息只会被反序列化一次;类型不同(比如有的用ShapeShifter)才会各自来一遍。
顺便解释了一个困惑:为什么用gdb断在回调里,栈里看不到任何socket相关的帧?因为回调的调用者是spinner,网络线程几微秒前就已经回去poll了。
CallbackQueue能干的事
它比"一个队列"复杂一些:
callOne和callAvailable,分别执行一个和执行当前全部可用的,都能带超时- 按ID移除。订阅者析构的时候把它排队中的回调清掉,免得调到已经销毁的对象
- TryAgain重排。回调返回TryAgain就不算完成,放回队列稍后重试,SubscriptionQueue被禁用或者暂时处理不了的时候就靠这个
- 用线程局部存储支持重入,允许在回调里再调一次callAvailable
还有个allow_concurrent_callbacks,决定同一个回调能不能被多个线程同时执行。默认是false,意味着就算用了多线程spinner,同一个订阅者的回调还是串行的。很多人用了MultiThreadedSpinner发现没有并行效果,原因就在这。
四种spin
ros::spin(),用SingleThreadedSpinner,阻塞循环处理全局队列ros::spinOnce(),等价于对全局回调队列执行callAvailable(WallDuration()),立即返回- MultiThreadedSpinner,阻塞,内部多线程处理同一个队列
- AsyncSpinner,自带线程组,start和stop,不阻塞调用者
"回调不执行"按这个顺序排查:
- 有没有spin?只publish不spin的循环里,订阅回调永远不会被调用,消息只是在队列里堆着然后被丢掉
- spinOnce的频率够不够?它只处理"当前可用"的,循环体里有耗时操作队列就会溢出
- Subscriber对象是不是已经析构了?
nh.subscribe(...)的返回值必须存住,否则订阅立刻失效,而且编译器不会给任何警告
自定义CallbackQueue
每个NodeHandle都可以用setCallbackQueue绑一个自己的CallbackQueue。这是把某些回调隔离到独立线程的标准做法,也基本是唯一的做法。
// 简化示意
ros::NodeHandle nh_fast;
ros::CallbackQueue fast_queue;
nh_fast.setCallbackQueue(&fast_queue);
ros::Subscriber s = nh_fast.subscribe("imu", 100, imuCb);
ros::AsyncSpinner fast_spinner(1, &fast_queue);
fast_spinner.start();
ros::spin(); // 主线程继续处理全局队列
典型用法就是把高频传感器回调、或者某个已知会阻塞的服务回调从主队列里摘出去,别让它拖慢别人。
还要提醒一句,ros::Timer的回调也走回调队列。所以一个阻塞的订阅回调会连带把同队列上的定时器拖慢,表现出来就是"定时器周期不准"。定时器不准的时候,第一嫌疑人是同队列上的慢回调,不是定时器本身。