uavcan_v1: Add update and print support to SubscriptionManager

This commit is contained in:
JacobCrabill
2021-07-06 22:00:07 -04:00
committed by Daniel Agar
parent 74d0f46279
commit 4ba1f966e5
2 changed files with 12 additions and 1 deletions
+11 -1
View File
@@ -88,10 +88,20 @@ void SubscriptionManager::subscribe()
void SubscriptionManager::printInfo() void SubscriptionManager::printInfo()
{ {
UavcanDynamicPortSubscriber *dynsub = _dynsubscribers;
while (dynsub != NULL) {
dynsub->printInfo();
dynsub = dynsub->next();
}
} }
void SubscriptionManager::updateParams() void SubscriptionManager::updateParams()
{ {
//TODO dynamically update params and unsubscribe UavcanDynamicPortSubscriber *dynsub = _dynsubscribers;
while (dynsub != NULL) {
dynsub->updateParam();
dynsub = dynsub->next();
}
} }
@@ -78,6 +78,7 @@ private:
UavcanDynamicPortSubscriber *_dynsubscribers {NULL}; UavcanDynamicPortSubscriber *_dynsubscribers {NULL};
UavcanHeartbeatSubscriber _heartbeat_sub {_canard_instance}; UavcanHeartbeatSubscriber _heartbeat_sub {_canard_instance};
// GetInfo response // GetInfo response
UavcanGetInfoResponse _getinfo_rsp {_canard_instance}; UavcanGetInfoResponse _getinfo_rsp {_canard_instance};