uavcan_v1: Add update and print support to SubscriptionManager

This commit is contained in:
JacobCrabill 2021-06-24 17:14:06 -07:00 committed by Daniel Agar
parent 74d0f46279
commit 4ba1f966e5
2 changed files with 12 additions and 1 deletions

View File

@ -88,10 +88,20 @@ void SubscriptionManager::subscribe()
void SubscriptionManager::printInfo()
{
UavcanDynamicPortSubscriber *dynsub = _dynsubscribers;
while (dynsub != NULL) {
dynsub->printInfo();
dynsub = dynsub->next();
}
}
void SubscriptionManager::updateParams()
{
//TODO dynamically update params and unsubscribe
UavcanDynamicPortSubscriber *dynsub = _dynsubscribers;
while (dynsub != NULL) {
dynsub->updateParam();
dynsub = dynsub->next();
}
}

View File

@ -78,6 +78,7 @@ private:
UavcanDynamicPortSubscriber *_dynsubscribers {NULL};
UavcanHeartbeatSubscriber _heartbeat_sub {_canard_instance};
// GetInfo response
UavcanGetInfoResponse _getinfo_rsp {_canard_instance};