PyFirmata2控制Arduino Nano舵机不稳定问题及PySerial替代咨询

先修复PyFirmata2的问题 #

你遇到的核心问题是**time.sleep阻塞了Firmata迭代器的后台通信**，导致串口指令堆积丢包，再加上全局变量的引用时机问题，才会出现舵机只执行前几个指令就失控的情况。试试下面几个修改：

1. 更新Arduino的Firmata固件
   打开Arduino IDE，选择文件>示例>Firmata>StandardFirmata，重新烧录到你的Nano上。旧版本Firmata固件存在舵机控制的兼容性bug，更新后能解决大部分通信问题。

2. 重构代码：替换time.sleep+取消全局变量
   time.sleep会让Python进程完全阻塞，负责和Arduino通信的Firmata迭代器无法及时处理串口数据，直接导致指令丢包。换成board.pass_time()，它会在等待时让迭代器继续运行；同时把角度作为参数直接传给函数，避免全局变量的引用坑：

import pyfirmata2
from pyfirmata2 import Arduino

board = Arduino("COM14")
iter8 = pyfirmata2.util.Iterator(board)
iter8.start()

servo_pinX = board.get_pin('d:9:s') 
servo_pinY = board.get_pin('d:10:s')         

def move_servoX(angle): 
    servo_pinX.write(angle)
    board.pass_time(0.2)  # 替代time.sleep，不阻塞迭代器

def move_servoY(angle):
    servo_pinY.write(angle)
    board.pass_time(0.2)

# 直接传角度，无需全局变量
move_servoX(18.0)
move_servoY(42.0)

move_servoX(93.0)
move_servoY(0.0)

move_servoX(89.0)
move_servoY(100.0)

move_servoX(8.0)
move_servoY(170.0)

move_servoX(3.0)
move_servoY(83.0)

move_servoX(149.0)
move_servoY(0.0)

move_servoX(90.0)
move_servoY(90.0)

board.exit()

3. 极端情况：关闭迭代器
   若上述修改仍无效，可尝试注释掉迭代器代码——部分场景下迭代器反而会干扰舵机指令的发送优先级：

import pyfirmata2
from pyfirmata2 import Arduino
import time

board = Arduino("COM14")
# 注释掉迭代器相关代码
# iter8 = pyfirmata2.util.Iterator(board)
# iter8.start()

servo_pinX = board.get_pin('d:9:s') 
servo_pinY = board.get_pin('d:10:s')         

def move_servoX(angle): 
    servo_pinX.write(angle)
    time.sleep(0.2)

def move_servoY(angle):
    servo_pinY.write(angle)
    time.sleep(0.2)

# 调用逻辑同上...

切换到PySerial完全可行，且稳定性更高 #

PySerial绕开了Firmata的中间层，直接通过串口发送指令给Arduino，实时性和稳定性远优于PyFirmata2，尤其适合舵机这种需要精准控制的场景。具体实现分两步：

Arduino端代码（烧录到Nano） #

#include <Servo.h>

Servo servoX;
Servo servoY;

void setup() {
  Serial.begin(9600);
  servoX.attach(9);
  servoY.attach(10);
}

void loop() {
  if (Serial.available() >= 4) {  // 接收格式：XxxxYxxx（例如X018Y042）
    char cmd = Serial.read();
    if (cmd == 'X') {
      int angle = Serial.parseInt();
      servoX.write(angle);
    } else if (cmd == 'Y') {
      int angle = Serial.parseInt();
      servoY.write(angle);
    }
    // 跳过换行符，避免残留数据干扰
    while(Serial.read() != '\n');
  }
}

Python端代码（用PySerial） #

import serial
import time

# 初始化串口，波特率与Arduino保持一致
ser = serial.Serial('COM14', 9600, timeout=1)
time.sleep(2)  # 等待Arduino重启完成

def move_servo(channel, angle):
    # 发送格式化指令，确保角度为3位数字（比如X008代表X舵机转到8度）
    cmd = f"{channel}{angle:03d}\n"
    ser.write(cmd.encode())
    time.sleep(0.2)

# 按需求发送舵机指令
move_servo('X', 18)
move_servo('Y', 42)

move_servo('X', 93)
move_servo('Y', 0)

move_servo('X', 89)
move_servo('Y', 100)

move_servo('X', 8)
move_servo('Y', 170)

move_servo('X', 3)
move_servo('Y', 83)

move_servo('X', 149)
move_servo('Y', 0)

move_servo('X', 90)
move_servo('Y', 90)

ser.close()

这种方式完全避免了Firmata的通信阻塞问题，舵机响应会更精准稳定。

内容的提问来源于stack exchange，提问作者Rayaan