Signed-off-by: Stephen Brawner <brawner@gmail.com>
This commit is contained in:
parent
b843c75ef8
commit
6e408b79f3
1 changed files with 11 additions and 1 deletions
|
@ -73,7 +73,17 @@ protected:
|
||||||
size_t services_from_waitables = 0;
|
size_t services_from_waitables = 0;
|
||||||
size_t events_from_waitables = 0;
|
size_t events_from_waitables = 0;
|
||||||
for (const auto & waitable_entry : waitables) {
|
for (const auto & waitable_entry : waitables) {
|
||||||
rclcpp::Waitable & waitable = *waitable_entry.waitable.get();
|
auto waitable_ptr_pair = get_raw_pointer_from_smart_pointer(waitable_entry.waitable);
|
||||||
|
if (nullptr == waitable_ptr_pair.second) {
|
||||||
|
if (HasStrongOwnership) {
|
||||||
|
throw std::runtime_error("unexpected condition, fixed storage policy needs pruning");
|
||||||
|
}
|
||||||
|
// Flag for pruning.
|
||||||
|
needs_pruning_ = true;
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
rclcpp::Waitable & waitable = *waitable_ptr_pair.second;
|
||||||
subscriptions_from_waitables += waitable.get_number_of_ready_subscriptions();
|
subscriptions_from_waitables += waitable.get_number_of_ready_subscriptions();
|
||||||
guard_conditions_from_waitables += waitable.get_number_of_ready_guard_conditions();
|
guard_conditions_from_waitables += waitable.get_number_of_ready_guard_conditions();
|
||||||
timers_from_waitables += waitable.get_number_of_ready_timers();
|
timers_from_waitables += waitable.get_number_of_ready_timers();
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue