以下是一段**控制机械臂挥手三次的 Python 代码示例**，适用于常见的支持串口通信（如 Arduino、Raspberry Pi + PCA9685、或 ROS 机械臂控制器）的硬件平台。为通用性和教学清晰性，我们采用 **模拟串口控制舵机角度** 的方式，并附详细中文注释。你可根据实际硬件（如 MG996R 舵机、UR3、Dynamixel 或 ROS `move_group`）替换底层驱动逻辑。 > ✅ 假设：机械臂有一个“肘部”或“肩部”舵机（ID=0），通过改变其角度实现“挥手”动作（类似人类小臂上下摆动） > ✅ 挥手定义：从初始位 → 向上摆 → 回中 → 向下摆 → 回中（1次完整挥手） > ✅ 共执行 3 次，每次间隔 0.8 秒，动作平滑（带插值过渡） --- ### ✅ 完整可运行代码（Python 3.x，需安装 `pyserial`）： ```python import time import serial from typing import List, Tuple # ==================== 【配置区】请根据你的硬件修改 ==================== # 串口参数（Arduino 示例：上传了接收 'S0:120' 格式指令的舵机控制程序） SERIAL_PORT = "COM3" # Windows 示例；Linux 用 "/dev/ttyUSB0"；Mac 用 "/dev/tty.usbmodemXXXX" BAUD_RATE = 9600 TIMEOUT = 1 # 舵机ID（若多舵机系统，此处指定负责挥手的关节，如肩部俯仰轴） SERVO_ID = 0 # 角度定义（单位：度） INIT_ANGLE = 90 # 初始中立位置（手臂自然下垂/前伸时的角度） UP_ANGLE = 60 # 向上挥手位置（角度减小 = 向上抬，取决于舵机安装方向） DOWN_ANGLE = 120 # 向下挥手位置（角度增大 = 向下摆） SPEED_MS = 200 # 舵机移动速度（毫秒级响应，越小越快；部分模块支持，如AX-12A） # 挥手一次的动作序列：[(目标角度, 持续时间秒), ...] WAVE_SEQUENCE: List[Tuple[int, float]] = [ (UP_ANGLE, 0.4), # 抬起 (INIT_ANGLE, 0.3), # 回中 (DOWN_ANGLE, 0.4), # 下压 (INIT_ANGLE, 0.3), # 回中 → 完成1次挥手 ] # 总挥手次数 WAVE_COUNT = 3 # =================================================================== def send_servo_command(ser: serial.Serial, servo_id: int, angle: int, speed: int = 0): """ 向舵机控制器发送指令（示例协议：S<id>:<angle>[,<speed>]） 例如：S0:60,200 → 控制0号舵机转到60°，速度200 ⚠️ 注意：具体协议需与你的下位机固件匹配（Arduino / STM32 / ROS node） """ if speed > 0: cmd = f"S{servo_id}:{angle},{speed}\n" else: cmd = f"S{servo_id}:{angle}\n" ser.write(cmd.encode('utf-8')) print(f"✅ 已发送指令: {cmd.strip()}") def smooth_move(ser: serial.Serial, servo_id: int, start_angle: int, end_angle: int, duration: float, steps: int = 10): """ 平滑过渡移动（线性插值），避免舵机突兀抖动 :param ser: 串口对象 :param servo_id: 舵机ID :param start_angle: 起始角度 :param end_angle: 目标角度 :param duration: 总耗时（秒） :param steps: 插值步数（越多越平滑，默认10） """ step_time = duration / steps delta = (end_angle - start_angle) / steps for i in range(1, steps + 1): target = int(start_angle + i * delta) # 限制角度在 0–180 安全范围（舵机典型范围） target = max(0, min(180, target)) send_servo_command(ser, servo_id, target, SPEED_MS) time.sleep(step_time) def main(): # 1️⃣ 初始化串口连接 try: ser = serial.Serial(SERIAL_PORT, BAUD_RATE, timeout=TIMEOUT) print(f"🔌 已连接至 {SERIAL_PORT} @ {BAUD_RATE}bps") time.sleep(1) # 等待下位机启动稳定 except serial.SerialException as e: print(f"❌ 串口打开失败: {e}") print("💡 请检查：1) 设备是否插入 2) 端口号是否正确 3) 驱动是否安装") return try: # 2️⃣ 发送初始位置指令（确保起始状态一致） print("➡️ 正在归位到初始角度...") send_servo_command(ser, SERVO_ID, INIT_ANGLE, SPEED_MS) time.sleep(1) # 3️⃣ 执行3次挥手 print(f"👋 开始挥手动作（共 {WAVE_COUNT} 次）...") for wave_idx in range(1, WAVE_COUNT + 1): print(f" 📌 第 {wave_idx} 次挥手:") current_angle = INIT_ANGLE # 按序列执行每个动作 for target_angle, hold_sec in WAVE_SEQUENCE: print(f" → 移动至 {target_angle}°，保持 {hold_sec:.1f}s") smooth_move(ser, SERVO_ID, current_angle, target_angle, duration=0.5) time.sleep(hold_sec) # 在目标位置短暂停留 current_angle = target_angle # 每次挥手后加一点间隔 if wave_idx < WAVE_COUNT: print(f" ⏸️ 休息 0.8 秒...") time.sleep(0.8) print("🎉 挥手完成！机械臂已就绪。") except KeyboardInterrupt: print("\n⚠️ 用户中断操作。") except Exception as e: print(f"❌ 运行异常: {e}") finally: # 4️⃣ 安全关闭 if 'ser' in locals() and ser.is_open: print("🔧 正在归位并关闭串口...") send_servo_command(ser, SERVO_ID, INIT_ANGLE) time.sleep(0.5) ser.close() print("✅ 串口已安全关闭。") # ==================== 【程序入口】==================== if __name__ == "__main__": main() ``` --- ### 🔍 关键注释说明： | 代码段 | 说明 | |--------|------| | `WAVE_SEQUENCE` | 定义一次挥手的**关键帧序列**：抬→中→压→中。你可增删帧（如加停顿、加速）来调整风格。 | | `smooth_move()` | 使用**线性插值 + 多步发送**，避免舵机“啪”地硬转，保护齿轮和电机寿命。 | | `send_servo_command()` | **协议抽象层**：只需修改此函数内字符串格式，即可适配不同下位机（如 ROS 的 `/joint_states`、Dynamixel 的 `write1ByteTxRx`、或自定义 Arduino `Serial.read()` 解析）。 | | `max(0, min(180, target))` | **安全钳位**：防止指令越界损坏舵机（典型MG996R范围0–180°）。 | | `time.sleep()` 精确控制节奏 | 确保动作有呼吸感，符合“挥手”的拟人化节律（非机器式瞬移）。 | --- ### 🛠️ 如何适配你的硬件？ | 你的平台 | 修改建议 | |----------|-----------| | **Arduino + SG90/MG996R** | 上传 [此基础舵机控制代码](https://gist.github.com/xxx) 到 Arduino，监听 `S0:90` 格式指令。 | | **Raspberry Pi + PCA9685 PWM 板** | 替换 `send_servo_command()` 为 `pca9685.set_pwm()` 调用（需 `Adafruit_PCA9685` 库）。 | | **ROS 机械臂（如 UR5、xArm）** | 将 `send_servo_command()` 替换为 `move_group.set_joint_value_target()` + `go()`。 | | **无硬件？纯仿真测试** | 注释掉 `ser.write(...)`，只保留 `print()`，验证逻辑与节奏。 | --- ### ✅ 运行前准备： ```bash pip install pyserial # 然后双击运行 .py 文件，或终端执行： python robot_wave.py ``` > 💡 提示：首次运行若报 `SerialException`，请打开「设备管理器」确认 COM 口编号，并替换 `SERIAL_PORT`。 ---