树莓派 PWM 控制四个步进电机不同转速和角度旋转代码

以下是一个使用 PWM 编程控制四个步进电机旋转角度和转速的代码示例：

import RPi.GPIO as GPIO
import time

# 定义每个步进电机的引脚
motor_pins = [[18, 23, 24, 25],   # 第一个步进电机的引脚
              [12, 16, 20, 21],   # 第二个步进电机的引脚
              [5, 6, 13, 19],     # 第三个步进电机的引脚
              [17, 22, 27, 4]]    # 第四个步进电机的引脚

# 设置GPIO模式为BCM模式
GPIO.setmode(GPIO.BCM)

# 设置每个引脚为输出模式
for pins in motor_pins:
    for pin in pins:
        GPIO.setup(pin, GPIO.OUT)

# 定义每个步进电机的转速和旋转角度
motor_speeds = [100, 200, 300, 400]   # 每个步进电机的转速（单位：步/秒）
motor_angles = [90, 180, 270, 360]    # 每个步进电机的旋转角度（单位：度）

# 定义PWM的频率和占空比
pwm_frequency = 100   # PWM的频率（单位：Hz）
pwm_duty_cycle = 50   # PWM的占空比（单位：%）

# 计算每个步进电机的转速对应的时间间隔
motor_intervals = [1 / speed for speed in motor_speeds]

# 旋转每个步进电机到指定的角度
def rotate_motor(motor_index, angle):
    steps = int((angle / 360) * 512)   # 计算需要转动的步数（每圈512步）
    pins = motor_pins[motor_index]     # 获取当前步进电机的引脚
    for _ in range(steps):
        for i in range(4):
            GPIO.output(pins[i], GPIO.HIGH)
            time.sleep(motor_intervals[motor_index] / 2)
            GPIO.output(pins[i], GPIO.LOW)
            time.sleep(motor_intervals[motor_index] / 2)

# 启动PWM
pwm = GPIO.PWM(motor_pins[0][0], pwm_frequency)
pwm.start(pwm_duty_cycle)

try:
    # 旋转每个步进电机到指定的角度
    for i in range(len(motor_pins)):
        rotate_motor(i, motor_angles[i])
        time.sleep(1)   # 等待1秒

finally:
    # 清理GPIO引脚
    GPIO.cleanup()

这段代码使用 RPi.GPIO 库来控制树莓派的 GPIO 引脚。首先，我们定义了每个步进电机的引脚，然后设置 GPIO 模式为 BCM 模式，并将每个引脚设置为输出模式。

接下来，我们定义了每个步进电机的转速和旋转角度。然后，我们计算了每个步进电机的转速对应的时间间隔。

在 rotate_motor 函数中，我们使用嵌套的循环来控制每个步进电机的引脚，以实现旋转。

在主程序中，我们启动了 PWM，并使用 rotate_motor 函数来旋转每个步进电机到指定的角度。然后，我们使用 time.sleep 函数等待 1 秒，以便观察旋转效果。

最后，我们在 finally 块中清理了 GPIO 引脚，以确保程序结束后引脚状态正确。