def run(self):
_rclpy.rclpy_wait(self.wait_set, -1)
response = _rclpy.rclpy_take_response(self.client.client_handle,
self.client.srv_type.Response,
self.client.sequence_number)
if response:
self.client.response = response
def run(self):
[sigint_gc, sigint_gc_handle] = _rclpy.rclpy_get_sigint_guard_condition()
_rclpy.rclpy_wait_set_add_entity('guard_condition', self.wait_set, sigint_gc)
_rclpy.rclpy_wait(self.wait_set, -1)
guard_condition_ready_list = \
_rclpy.rclpy_get_ready_entities('guard_condition', self.wait_set)
# destroying here to make sure we dont call shutdown before cleaning up
_rclpy.rclpy_destroy_entity(sigint_gc)
if sigint_gc_handle in guard_condition_ready_list:
rclpy.utilities.shutdown()
return
seq, response = _rclpy.rclpy_take_response(
self.client.client_handle,
self.client.srv_type.Response)
if seq is not None and seq == self.client.sequence_number:
self.client.response = response
def take_data(self):
"""Take stuff from lower level so the wait set doesn't immediately wake again."""
if self.client_is_ready:
self.client_is_ready = False
return _rclpy.rclpy_take_response(self.client, EmptySrv.Response)
return None
def _take_client(self, client):
return _rclpy.rclpy_take_response(client.client_handle,
client.srv_type.Response)
def _take_client(self, client):
with client.handle as capsule:
return _rclpy.rclpy_take_response(capsule,
client.srv_type.Response)
def run(self):
_rclpy.rclpy_wait(self.wait_set, -1)
response = _rclpy.rclpy_take_response(
self.client.client_handle, self.client.srv_type.Response, self.client.sequence_number)
if response:
self.client.response = response
def spin_once(node, timeout_sec=None):
wait_set = _rclpy.rclpy_get_zero_initialized_wait_set()
_rclpy.rclpy_wait_set_init(
wait_set,
len(node.subscriptions),
1,
len(node.timers),
len(node.clients),
len(node.services))
[sigint_gc, sigint_gc_handle] = _rclpy.rclpy_get_sigint_guard_condition()
entities = {
'subscription': (node.subscriptions, 'subscription_handle'),
'client': (node.clients, 'client_handle'),
'service': (node.services, 'service_handle'),
'timer': (node.timers, 'timer_handle'),
}
for entity, (handles, handle_name) in entities.items():
_rclpy.rclpy_wait_set_clear_entities(entity, wait_set)
for h in handles:
_rclpy.rclpy_wait_set_add_entity(
entity, wait_set, h.__getattribute__(handle_name)
)
_rclpy.rclpy_wait_set_clear_entities('guard_condition', wait_set)
_rclpy.rclpy_wait_set_add_entity('guard_condition', wait_set, sigint_gc)
if timeout_sec is None:
timeout = -1
else:
timeout = int(float(timeout_sec) * S_TO_NS)
_rclpy.rclpy_wait(wait_set, timeout)
guard_condition_ready_list = _rclpy.rclpy_get_ready_entities('guard_condition', wait_set)
if sigint_gc_handle in guard_condition_ready_list:
raise KeyboardInterrupt
timer_ready_list = _rclpy.rclpy_get_ready_entities('timer', wait_set)
for tmr in [t for t in node.timers if t.timer_pointer in timer_ready_list]:
if _rclpy.rclpy_is_timer_ready(tmr.timer_handle):
_rclpy.rclpy_call_timer(tmr.timer_handle)
tmr.callback()
sub_ready_list = _rclpy.rclpy_get_ready_entities('subscription', wait_set)
for sub in [s for s in node.subscriptions if s.subscription_pointer in sub_ready_list]:
msg = _rclpy.rclpy_take(sub.subscription_handle, sub.msg_type)
if msg:
sub.callback(msg)
client_ready_list = _rclpy.rclpy_get_ready_entities('client', wait_set)
for client in [c for c in node.clients if c.client_pointer in client_ready_list]:
response = _rclpy.rclpy_take_response(
client.client_handle, client.srv_type.Response, client.sequence_number)
if response:
# clients spawn their own thread to wait for a response in the wait_for_future function
# users can either use this mechanism or monitor the content of
# client.response themselves to check if a response have been received
client.response = response
service_ready_list = _rclpy.rclpy_get_ready_entities('service', wait_set)
for srv in [s for s in node.services if s.service_pointer in service_ready_list]:
request_and_header = _rclpy.rclpy_take_request(srv.service_handle, srv.srv_type.Request)
if request_and_header is None:
continue
[request, header] = request_and_header
if request:
response = srv.callback(request, srv.srv_type.Response())
srv.send_response(response, header)
def spin_once(node, timeout_sec=None):
wait_set = _rclpy.rclpy_get_zero_initialized_wait_set()
_rclpy.rclpy_wait_set_init(wait_set, len(node.subscriptions), 1,
len(node.timers), len(node.clients),
len(node.services))
[sigint_gc, sigint_gc_handle] = _rclpy.rclpy_get_sigint_guard_condition()
entities = {
'subscription': (node.subscriptions, 'subscription_handle'),
'client': (node.clients, 'client_handle'),
'service': (node.services, 'service_handle'),
'timer': (node.timers, 'timer_handle'),
}
for entity, (handles, handle_name) in entities.items():
_rclpy.rclpy_wait_set_clear_entities(entity, wait_set)
for h in handles:
_rclpy.rclpy_wait_set_add_entity(entity, wait_set,
h.__getattribute__(handle_name))
_rclpy.rclpy_wait_set_clear_entities('guard_condition', wait_set)
_rclpy.rclpy_wait_set_add_entity('guard_condition', wait_set, sigint_gc)
if timeout_sec is None:
timeout = -1
else:
timeout = int(float(timeout_sec) * S_TO_NS)
_rclpy.rclpy_wait(wait_set, timeout)
guard_condition_ready_list = _rclpy.rclpy_get_ready_entities(
'guard_condition', wait_set)
if sigint_gc_handle in guard_condition_ready_list:
raise KeyboardInterrupt
timer_ready_list = _rclpy.rclpy_get_ready_entities('timer', wait_set)
for tmr in [t for t in node.timers if t.timer_pointer in timer_ready_list]:
if _rclpy.rclpy_is_timer_ready(tmr.timer_handle):
_rclpy.rclpy_call_timer(tmr.timer_handle)
tmr.callback()
sub_ready_list = _rclpy.rclpy_get_ready_entities('subscription', wait_set)
for sub in [
s for s in node.subscriptions
if s.subscription_pointer in sub_ready_list
]:
msg = _rclpy.rclpy_take(sub.subscription_handle, sub.msg_type)
if msg:
sub.callback(msg)
client_ready_list = _rclpy.rclpy_get_ready_entities('client', wait_set)
for client in [
c for c in node.clients if c.client_pointer in client_ready_list
]:
response = _rclpy.rclpy_take_response(client.client_handle,
client.srv_type.Response,
client.sequence_number)
if response:
# clients spawn their own thread to wait for a response in the wait_for_future function
# users can either use this mechanism or monitor the content of
# client.response themselves to check if a response have been received
client.response = response
service_ready_list = _rclpy.rclpy_get_ready_entities('service', wait_set)
for srv in [
s for s in node.services if s.service_pointer in service_ready_list
]:
request_and_header = _rclpy.rclpy_take_request(srv.service_handle,
srv.srv_type.Request)
if request_and_header is None:
continue
[request, header] = request_and_header
if request:
response = srv.callback(request, srv.srv_type.Response())
srv.send_response(response, header)
def _take_client(self, client):
response = _rclpy.rclpy_take_response(
client.client_handle, client.srv_type.Response, client.sequence_number)
return response
