ros2与Python入门教程-创建action客户端_ros2 logger

来源: https://www.ncnynl.com/archives/202008/3824.html
说明：

介绍如何创建action客户端
步骤：

进入目录,新建文件fibonacci_action_client.py

cd ~/dev_ws/src/action_tutorials/action_tutorials
vim fibonacci_action_client.py
1
2

内容如下：

import rclpy
from rclpy.node import Node
from rclpy.action import ActionClient
from action_tutorials.action import Fibonacci


class FibonacciActionClient(Node):

    def __init__(self):
        super().__init__('fibonacci_action_client')
        self._action_client = ActionClient(self, Fibonacci, 'fibonacci')

    def send_goal(self, order):
        goal_msg = Fibonacci.Goal()
        goal_msg.order = order
        self._action_client.wait_for_server()
        self._send_goal_future = self._action_client.send_goal_async(
            goal_msg,
            feedback_callback=self.feedback_callback)

        self._send_goal_future.add_done_callback(self.goal_response_callback)

    def goal_response_callback(self, future):
        goal_handle = future.result()
        if not goal_handle.accepted:
            self.get_logger().info('Goal rejected :(')
            return

        self.get_logger().info('Goal accepted :)')
        self._get_result_future = goal_handle.get_result_async()
        self._get_result_future.add_done_callback(self.get_result_callback)

    def get_result_callback(self, future):
        result = future.result().result
        self.get_logger().info('Result: {0}'.format(result.sequence))
        rclpy.shutdown()

    def feedback_callback(self, feedback_msg):
        feedback = feedback_msg.feedback
        self.get_logger().info('Received feedback: {0}'.format(feedback.partial_sequence))


def main(args=None):
    rclpy.init(args=args)

    action_client = FibonacciActionClient()
    action_client.send_goal(10)
    rclpy.spin(action_client)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48

if __name__ == '__main__':
    main()
1
2

编译

cd ~/dev_ws/
colcon build --packages-select action_tutorials
1
2

新开终端，运行

. install/setup.bash
cd ~/dev_ws/src/action_tutorials/action_tutorials/
python3 fibonacci_action_client.py
1
2
3