1515#include " handle_manager.hpp"
1616
1717#include < rcl_action/rcl_action.h>
18+
1819#include < vector>
1920
2021#include " spdlog/spdlog.h"
@@ -80,15 +81,11 @@ void HandleManager::CollectHandles(const v8::Local<v8::Object> node) {
8081 is_synchronizing_.store (false );
8182 uv_sem_post (&sem_);
8283
83- SPDLOG_DEBUG (
84- spdlog::get (" rclnodejs" ),
85- " Add {0:d} timers, {1:d} subscriptions, {2:d} clients, " +
86- " {3:d} services, {4:d} guards." ,
87- timers_.size (),
88- subscriptions_.size (),
89- clients_.size (),
90- services_.size (),
91- guard_conditions_.size ());
84+ SPDLOG_DEBUG (spdlog::get (" rclnodejs" ),
85+ " Add {0:d} timers, {1:d} subscriptions, {2:d} clients, " +
86+ " {3:d} services, {4:d} guards." ,
87+ timers_.size (), subscriptions_.size (), clients_.size (),
88+ services_.size (), guard_conditions_.size ());
9289}
9390
9491bool HandleManager::AddHandlesToWaitSet (rcl_wait_set_t * wait_set) {
@@ -98,7 +95,7 @@ bool HandleManager::AddHandlesToWaitSet(rcl_wait_set_t* wait_set) {
9895 return false ;
9996 }
10097 for (auto & subscription : subscriptions_) {
101- rcl_subscription_t * rcl_subscription =
98+ rcl_subscription_t * rcl_subscription =
10299 reinterpret_cast <rcl_subscription_t *>(subscription->ptr ());
103100 if (rcl_wait_set_add_subscription (wait_set, rcl_subscription, nullptr ) !=
104101 RCL_RET_OK)
@@ -118,22 +115,22 @@ bool HandleManager::AddHandlesToWaitSet(rcl_wait_set_t* wait_set) {
118115 for (auto & guard_condition : guard_conditions_) {
119116 rcl_guard_condition_t * rcl_guard_condition =
120117 reinterpret_cast <rcl_guard_condition_t *>(guard_condition->ptr ());
121- if (rcl_wait_set_add_guard_condition (wait_set, rcl_guard_condition, nullptr )
122- != RCL_RET_OK)
118+ if (rcl_wait_set_add_guard_condition (wait_set, rcl_guard_condition,
119+ nullptr ) != RCL_RET_OK)
123120 return false ;
124121 }
125122 for (auto & action_client : action_clients_) {
126123 rcl_action_client_t * rcl_action_client =
127124 reinterpret_cast <rcl_action_client_t *>(action_client->ptr ());
128125 if (rcl_action_wait_set_add_action_client (wait_set, rcl_action_client,
129- nullptr , nullptr ) != RCL_RET_OK)
126+ nullptr , nullptr ) != RCL_RET_OK)
130127 return false ;
131128 }
132129 for (auto & action_server : action_servers_) {
133130 rcl_action_server_t * rcl_action_server =
134131 reinterpret_cast <rcl_action_server_t *>(action_server->ptr ());
135132 if (rcl_action_wait_set_add_action_server (wait_set, rcl_action_server,
136- nullptr ) != RCL_RET_OK)
133+ nullptr ) != RCL_RET_OK)
137134 return false ;
138135 }
139136
@@ -143,36 +140,25 @@ bool HandleManager::AddHandlesToWaitSet(rcl_wait_set_t* wait_set) {
143140bool HandleManager::CollectReadyHandles (rcl_wait_set_t * wait_set) {
144141 ready_handles_.clear ();
145142
146- CollectReadyHandlesByType (
147- wait_set->subscriptions ,
148- wait_set->size_of_subscriptions ,
149- subscriptions_);
150- CollectReadyHandlesByType (
151- wait_set->clients ,
152- wait_set->size_of_clients ,
153- clients_);
154- CollectReadyHandlesByType (
155- wait_set->services ,
156- wait_set->size_of_services ,
157- services_);
158- CollectReadyHandlesByType (
159- wait_set->timers ,
160- wait_set->size_of_timers ,
161- timers_);
162- CollectReadyHandlesByType (
163- wait_set->guard_conditions ,
164- wait_set->size_of_guard_conditions ,
165- guard_conditions_);
143+ CollectReadyHandlesByType (wait_set->subscriptions ,
144+ wait_set->size_of_subscriptions , subscriptions_);
145+ CollectReadyHandlesByType (wait_set->clients , wait_set->size_of_clients ,
146+ clients_);
147+ CollectReadyHandlesByType (wait_set->services , wait_set->size_of_services ,
148+ services_);
149+ CollectReadyHandlesByType (wait_set->timers , wait_set->size_of_timers ,
150+ timers_);
151+ CollectReadyHandlesByType (wait_set->guard_conditions ,
152+ wait_set->size_of_guard_conditions ,
153+ guard_conditions_);
166154
167155 return CollectReadyActionHandles (wait_set);
168156}
169157
170- bool HandleManager::GetEntityCounts (
171- size_t *subscriptions_size,
172- size_t *guard_conditions_size,
173- size_t *timers_size,
174- size_t *clients_size,
175- size_t *services_size) {
158+ bool HandleManager::GetEntityCounts (size_t * subscriptions_size,
159+ size_t * guard_conditions_size,
160+ size_t * timers_size, size_t * clients_size,
161+ size_t * services_size) {
176162 size_t num_subscriptions = 0u ;
177163 size_t num_guard_conditions = 0u ;
178164 size_t num_timers = 0u ;
@@ -183,12 +169,8 @@ bool HandleManager::GetEntityCounts(
183169 rcl_action_client_t * rcl_action_client =
184170 reinterpret_cast <rcl_action_client_t *>(action_client->ptr ());
185171 rcl_ret_t ret = rcl_action_client_wait_set_get_num_entities (
186- rcl_action_client,
187- &num_subscriptions,
188- &num_guard_conditions,
189- &num_timers,
190- &num_clients,
191- &num_services);
172+ rcl_action_client, &num_subscriptions, &num_guard_conditions,
173+ &num_timers, &num_clients, &num_services);
192174 if (ret != RCL_RET_OK) {
193175 return false ;
194176 }
@@ -204,12 +186,8 @@ bool HandleManager::GetEntityCounts(
204186 rcl_action_server_t * rcl_action_server =
205187 reinterpret_cast <rcl_action_server_t *>(action_server->ptr ());
206188 rcl_ret_t ret = rcl_action_server_wait_set_get_num_entities (
207- rcl_action_server,
208- &num_subscriptions,
209- &num_guard_conditions,
210- &num_timers,
211- &num_clients,
212- &num_services);
189+ rcl_action_server, &num_subscriptions, &num_guard_conditions,
190+ &num_timers, &num_clients, &num_services);
213191 if (ret != RCL_RET_OK) {
214192 return false ;
215193 }
@@ -246,13 +224,16 @@ void HandleManager::CollectHandlesByType(
246224 Nan::HandleScope scope;
247225
248226 if (typeObject->IsArray ()) {
249- uint32_t length = Nan::To<uint32_t >(
250- Nan::Get (typeObject, Nan::New (" length" ).ToLocalChecked ())
251- .ToLocalChecked ()).FromJust ();
227+ uint32_t length =
228+ Nan::To<uint32_t >(
229+ Nan::Get (typeObject, Nan::New (" length" ).ToLocalChecked ())
230+ .ToLocalChecked ())
231+ .FromJust ();
252232
253233 for (uint32_t index = 0 ; index < length; index++) {
254- v8::Local<v8::Object> obj = Nan::To<v8::Object>(
255- Nan::Get (typeObject, index).ToLocalChecked ()).ToLocalChecked ();
234+ v8::Local<v8::Object> obj =
235+ Nan::To<v8::Object>(Nan::Get (typeObject, index).ToLocalChecked ())
236+ .ToLocalChecked ();
256237 Nan::MaybeLocal<v8::Value> handle =
257238 Nan::Get (obj, Nan::New (" _handle" ).ToLocalChecked ());
258239 rclnodejs::RclHandle* rcl_handle =
@@ -263,10 +244,9 @@ void HandleManager::CollectHandlesByType(
263244 }
264245}
265246
266- template <typename T>
247+ template <typename T>
267248void HandleManager::CollectReadyHandlesByType (
268- const T** struct_ptr,
269- size_t size,
249+ const T** struct_ptr, size_t size,
270250 const std::vector<rclnodejs::RclHandle*>& handles) {
271251 for (size_t idx = 0 ; idx < size; ++idx) {
272252 if (struct_ptr[idx]) {
@@ -290,12 +270,8 @@ bool HandleManager::CollectReadyActionHandles(rcl_wait_set_t* wait_set) {
290270 rcl_action_client_t * rcl_action_client =
291271 reinterpret_cast <rcl_action_client_t *>(action_client->ptr ());
292272 rcl_ret_t ret = rcl_action_client_wait_set_get_entities_ready (
293- wait_set,
294- rcl_action_client,
295- &is_feedback_ready,
296- &is_status_ready,
297- &is_goal_response_ready,
298- &is_cancel_response_ready,
273+ wait_set, rcl_action_client, &is_feedback_ready, &is_status_ready,
274+ &is_goal_response_ready, &is_cancel_response_ready,
299275 &is_result_response_ready);
300276 if (ret != RCL_RET_OK) {
301277 return false ;
@@ -325,12 +301,8 @@ bool HandleManager::CollectReadyActionHandles(rcl_wait_set_t* wait_set) {
325301 rcl_action_server_t * rcl_action_server =
326302 reinterpret_cast <rcl_action_server_t *>(action_server->ptr ());
327303 rcl_ret_t ret = rcl_action_server_wait_set_get_entities_ready (
328- wait_set,
329- rcl_action_server,
330- &is_goal_request_ready,
331- &is_cancel_request_ready,
332- &is_result_request_ready,
333- &is_goal_expired);
304+ wait_set, rcl_action_server, &is_goal_request_ready,
305+ &is_cancel_request_ready, &is_result_request_ready, &is_goal_expired);
334306 if (ret != RCL_RET_OK) {
335307 return false ;
336308 }
0 commit comments