def execute_with_feedback(goal_handle):
try:
goal_handle.publish_feedback('different feedback type')
except TypeError:
feedback = Fibonacci.Feedback()
feedback.sequence = [1, 1, 2, 3]
goal_handle.publish_feedback(feedback)
goal_handle.succeed()
return Fibonacci.Result()
def execute_callback(self, goal_handle):
feedback = Fibonacci.Feedback()
feedback.sequence = [0, 1]
for i in range(1, goal_handle.request.order):
feedback.sequence.append(feedback.sequence[i] + feedback.sequence[i-1])
goal_handle.publish_feedback(feedback)
goal_handle.succeed()
result = Fibonacci.Result()
result.sequence = feedback.sequence
return result
def execute_goal(goal_handle):
goal = goal_handle.request
feedback = Fibonacci.Feedback()
feedback.sequence = [0, 1]
for i in range(1, goal.order):
if not rclpy.ok():
goal_handle.set_aborted()
return Fibonacci.Result()
# Check if the goal was canceled
if goal_handle.is_cancel_requested:
goal_handle.set_canceled()
result = Fibonacci.Result()
result.sequence = feedback.sequence
print('Goal was canceled')
return result
# Update the sequence.
feedback.sequence.append(feedback.sequence[i] +
feedback.sequence[i - 1])
# Publish feedback
goal_handle.publish_feedback(feedback)
print('Publishing feedback')
# 10 Hz update rate
time.sleep(0.1)
# Send final result
result = Fibonacci.Result()
result.sequence = feedback.sequence
goal_handle.set_succeeded()
print('Goal succeeded')
return result
def execute_goal_callback(self, goal_handle):
goal_handle.succeed()
return Fibonacci.Result()
def execute_with_feedback(goal_handle):
feedback = Fibonacci.Feedback()
feedback.sequence = [1, 1, 2, 3]
goal_handle.publish_feedback(feedback)
goal_handle.succeed()
return Fibonacci.Result()
def execute_callback(goal_handle):
# Do not set the goal handles state
result = Fibonacci.Result()
result.sequence.extend([1, 1, 2, 3, 5])
return result
def execute_callback(goal_handle):
self.assertEqual(goal_handle.status, GoalStatus.STATUS_EXECUTING)
result = Fibonacci.Result()
result.sequence.extend([1, 1, 2, 3, 5])
goal_handle.abort()
return result
def execute_callback(gh):
# The goal should already be in state CANCELING
self.assertTrue(gh.is_cancel_requested)
gh.canceled()
return Fibonacci.Result()
def execute_callback(goal_handle):
# Wait, to give the opportunity to cancel
time.sleep(3.0)
self.assertFalse(goal_handle.is_cancel_requested)
goal_handle.canceled()
return Fibonacci.Result()
def action_callback(self, goal_handle):
goal_handle.succeed()
return Fibonacci.Result()
