在Python中使用actionlibSimpleActionServer()创建并运行动作服务器

在Python中，可以使用actionlib.SimpleActionServer()来创建和运行动作服务器。动作服务器允许我们处理客户端发送的请求，并发送反馈和结果。

下面是一个创建和运行动作服务器的示例：

import rospy
import actionlib
from my_package.msg import MyAction, MyActionFeedback, MyActionResult

def action_callback(goal):
    # 在这里编写处理客户端请求的代码
    # 可以根据需要访问 goal 中的字段

    # 创建一个反馈对象并发送反馈
    feedback = MyActionFeedback()
    feedback.feedback_field = 0.0
    
    while not rospy.is_shutdown():
        # 在这里编写执行任务的代码
        # 在任务执行过程中可以根据需要发送反馈

        # 如果任务完成，发送最终结果并退出循环
        if goal_condition_met:
            result = MyActionResult()
            result.result_field = 1.0
            server.set_succeeded(result)
            break

        # 更新反馈字段并发送反馈
        feedback.feedback_field += 0.1
        server.publish_feedback(feedback)
        rospy.sleep(1.0)

def main():
    rospy.init_node('action_server_node')

    # 创建动作服务器
    server = actionlib.SimpleActionServer('my_action', MyAction, action_callback, auto_start=False)

    # 设置服务器启动
    server.start()

    rospy.spin()

if __name__ == '__main__':
    main()

在上面的示例中，我们首先导入了rospy和actionlib库，并导入了自定义的消息类型MyAction，MyActionFeedback和MyActionResult。然后，我们定义了一个名为action_callback的回调函数，用于处理客户端发送的请求。在回调函数中，我们可以根据需要进行请求处理，并发送反馈和结果。

在action_callback函数中，我们首先创建了一个反馈对象feedback，并设置了其中的字段。然后，在一个循环中执行任务，并在任务执行过程中发送反馈。如果任务完成，我们发送最终结果并退出循环。在循环中，我们使用server.publish_feedback()方法来发送反馈。

在main函数中，我们首先初始化了ROS节点，并创建了一个名为my_action的动作服务器。然后，我们启动服务器并使用rospy.spin()来使程序保持运行状态。

请注意，上述示例中的消息类型MyAction，MyActionFeedback和MyActionResult需要根据实际情况进行替换。此外，还需要根据实际情况修改action_callback函数中的代码来处理客户端请求和执行任务。

为了能够使用该动作服务器，您需要在客户端中创建一个相应的动作客户端，并将请求发送到该服务器。关于动作客户端的使用以及如何与动作服务器进行通信的详细示例，请参阅官方文档或其他资料。