Python中actionlibSimpleActionServer()的基本工作原理

actionlibSimpleActionServer() 是一个用于创建简单动作服务器的类。它允许你定义一个服务器，用于接收和处理来自客户端的动作请求。

基本工作原理：

1. 创建一个动作服务器对象，并指定该服务器将处理的动作类型。例如，可以创建一个名为server的服务器对象，用于处理ActionA动作类型。

2. 定义一个回调函数，用于处理收到的动作请求。

3. 注册回调函数到服务器对象上，以便当服务器接收到来自客户端的请求时，可以调用该回调函数进行处理。

4. 开始运行服务器，使其开始接收和处理动作请求。

下面是一个使用actionlibSimpleActionServer()的例子：

import rospy
import actionlib
from actionlib.msg import TestAction, TestFeedback, TestResult

# 定义回调函数，用于处理接收到的动作请求
def callback(goal):
    # 创建一个反馈对象，用于向客户端报告服务器的进展状态
    feedback = TestFeedback()
    # 创建一个结果对象，用于向客户端报告服务器的最终结果
    result = TestResult()

    # 执行动作处理
    for i in range(1, goal.target + 1):
        # 更新反馈对象的进展状态
        feedback.progress = i
        # 发布当前进展状态的反馈消息
        server.publish_feedback(feedback)
        # 模拟动作处理时间
        rospy.sleep(1.0)

    # 设置结果对象的状态为成功
    result.success = True
    # 发布最终结果
    server.set_succeeded(result)

# 创建动作服务器对象，并指定要处理的动作类型为TestAction
rospy.init_node('action_server')
server = actionlib.SimpleActionServer('test_action', TestAction, callback, auto_start=False)

# 打开服务器，开始接收和处理动作请求
server.start()

# 进入主循环，等待退出信号
rospy.spin()

在上面的例子中，首先导入了必要的库。然后，定义了一个名为callback的回调函数，用于处理接收到的动作请求。在服务器启动之前，创建了一个动作服务器对象server，指定了要处理的动作类型为TestAction，并将回调函数callback注册到服务器上。最后，通过server.start()来开启服务器，使其开始接收和处理动作请求。

在callback函数中，首先创建了反馈对象feedback和结果对象result，用于向客户端报告服务器的进展状态和最终结果。然后使用一个循环来模拟动作处理的过程，每秒发送一个反馈消息，直到达到目标值。最后，将结果对象的状态设置为成功，并使用server.set_succeeded(result)来发布最终结果。

以上是actionlibSimpleActionServer()的基本工作原理和一个简单的使用例子。你可以根据自己的需求，修改回调函数中的逻辑，以实现更复杂的动作处理。