ros2与Python入门教程-创建action服务端_ros工作空间创建新的action

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

介绍如何创建action服务端
步骤：

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

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

内容如下:

import time
import rclpy
from rclpy.node import Node
from rclpy.action import ActionServer
from action_tutorials.action import Fibonacci


class FibonacciActionServer(Node):

    def __init__(self):
        super().__init__('fibonacci_action_server')
        self._action_server = ActionServer(
            self,
            Fibonacci,
            'fibonacci',
            self.execute_callback)

    def execute_callback(self, goal_handle):
        self.get_logger().info('Executing goal...')
        feedback_msg = Fibonacci.Feedback()
        feedback_msg.partial_sequence = [0, 1]

        for i in range(1, goal_handle.request.order):
            feedback_msg.partial_sequence.append(
                feedback_msg.partial_sequence[i] + feedback_msg.partial_sequence[i-1])
            self.get_logger().info('Feedback: {0}'.format(feedback_msg.partial_sequence))
            goal_handle.publish_feedback(feedback_msg)
            time.sleep(1)

        goal_handle.succeed()
        result = Fibonacci.Result()
        result.sequence = feedback_msg.partial_sequence
        return result

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

    fibonacci_action_server = FibonacciActionServer()

    rclpy.spin(fibonacci_action_server)


if __name__ == '__main__':
    main()
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

编译

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_server.py
1
2
3

新开终端，执行

ros2 action send_goal --feedback fibonacci action_tutorials/action/Fibonacci "{order: 5}"
1