### 实现速度控制的服务端和客户端 在机器人操作系统(ROS)环境中，通过Python实现服务端和客户端之间的速度控制涉及创建两个节点：一个是提供速度设置功能的服务端；另一个是可以请求这些设置的客户端。下面展示了一个简单的例子来说明这一过程。 #### 创建服务文件 首先，在`ros_ws/src/your_package/srv`目录下定义一个新的`.srv`文件用于描述要交换的数据类型。对于速度控制来说，可以简单地传递线性和角速度作为浮点数： ```plaintext float64 linear_speed float64 angular_speed --- bool success string message ``` 这表示当调用此服务时，发送者会给出期望的线性速度和角度速度，而接收方则返回操作成功与否以及一条消息[^1]。 #### 编写服务器脚本 接下来编写一个名为`speed_server.py`的服务端程序，它监听来自其他节点的速度更改请求并相应调整机器人的运动参数： ```python #!/usr/bin/env python import rospy from your_package.srv import SpeedControl, SpeedControlResponse from geometry_msgs.msg import Twist def handle_speed_control(req): vel_msg = Twist() # 设置线速度 vel_msg.linear.x = req.linear_speed # 设置角速度 vel_msg.angular.z = req.angular_speed pub.publish(vel_msg) return SpeedControlResponse(True, "Speed updated successfully") if __name__ == "__main__": rospy.init_node('speed_service') s = rospy.Service('set_speed', SpeedControl, handle_speed_control) pub = rospy.Publisher('/cmd_vel', Twist, queue_size=10) print("Ready to receive speed commands.") rospy.spin() ``` 这段代码初始化了一个新的ROS节点，并注册了一个处理函数以响应针对设定速度的服务呼叫。每当收到新命令时，就会更新发布到`/cmd_vel`主题上的Twist消息中的速度值[^2]。 #### 客户端示例 最后，这里有一个基本的客户端脚本(`speed_client.py`)用来向上述服务发出请求： ```python #!/usr/bin/env python import sys import rospy from your_package.srv import SpeedControl def set_robot_speed(lin_spd, ang_spd): rospy.wait_for_service('set_speed') try: sp_srv = rospy.ServiceProxy('set_speed', SpeedControl) resp = sp_srv(lin_spd, ang_spd) return resp.success, resp.message except rospy.ServiceException as e: print(f"Service call failed: {e}") if __name__ == "__main__": if len(sys.argv) != 3: print("Usage: rosrun your_package speed_client.py [linear_velocity] [angular_velocity]") sys.exit(1) lin_v = float(sys.argv[1]) ang_v = float(sys.argv[2]) print(set_robot_speed(lin_v, ang_v)) ``` 这个脚本允许用户从命令行输入想要改变的目标线速度和角速度，并将其转发给之前建立的服务端进行实际执行。