logger: unsubscribe from all topics when logger exits

This commit is contained in:
Beat Küng
2016-05-13 16:23:34 +02:00
committed by Lorenz Meier
parent 0f30bfa0ac
commit 4b8152465d
+10
View File
@@ -670,6 +670,16 @@ void Logger::run()
PX4_WARN("join failed: %d", ret);
}
//unsubscribe
for (LoggerSubscription &sub : _subscriptions) {
for (uint8_t instance = 0; instance < ORB_MULTI_MAX_INSTANCES; instance++) {
if (sub.fd[instance] != -1) {
orb_unsubscribe(sub.fd[instance]);
sub.fd[instance] = -1;
}
}
}
if (_mavlink_log_pub) {
orb_unadvertise(_mavlink_log_pub);
_mavlink_log_pub = nullptr;