树莓派控制42电机驱动麦克纳姆轮完整程序

以下是一个使用42电机驱动麦克纳姆轮的完整程序示例：

import RPi.GPIO as GPIO
import time

# 定义电机引脚
# 左侧电机
AIN1 = 17
AIN2 = 27
BIN1 = 22
BIN2 = 23
# 右侧电机
CIN1 = 24
CIN2 = 25
DIN1 = 5
DIN2 = 6

# 初始化GPIO
def init():
    GPIO.setmode(GPIO.BCM)
    GPIO.setup(AIN1, GPIO.OUT)
    GPIO.setup(AIN2, GPIO.OUT)
    GPIO.setup(BIN1, GPIO.OUT)
    GPIO.setup(BIN2, GPIO.OUT)
    GPIO.setup(CIN1, GPIO.OUT)
    GPIO.setup(CIN2, GPIO.OUT)
    GPIO.setup(DIN1, GPIO.OUT)
    GPIO.setup(DIN2, GPIO.OUT)

# 启动电机
def motor_start():
    GPIO.output(AIN1, GPIO.HIGH)
    GPIO.output(AIN2, GPIO.LOW)
    GPIO.output(BIN1, GPIO.HIGH)
    GPIO.output(BIN2, GPIO.LOW)
    GPIO.output(CIN1, GPIO.HIGH)
    GPIO.output(CIN2, GPIO.LOW)
    GPIO.output(DIN1, GPIO.HIGH)
    GPIO.output(DIN2, GPIO.LOW)

# 停止电机
def motor_stop():
    GPIO.output(AIN1, GPIO.LOW)
    GPIO.output(AIN2, GPIO.LOW)
    GPIO.output(BIN1, GPIO.LOW)
    GPIO.output(BIN2, GPIO.LOW)
    GPIO.output(CIN1, GPIO.LOW)
    GPIO.output(CIN2, GPIO.LOW)
    GPIO.output(DIN1, GPIO.LOW)
    GPIO.output(DIN2, GPIO.LOW)

# 控制机器人前进
def move_forward(t):
    motor_start()
    time.sleep(t)
    motor_stop()

# 控制机器人后退
def move_backward(t):
    GPIO.output(AIN1, GPIO.LOW)
    GPIO.output(AIN2, GPIO.HIGH)
    GPIO.output(BIN1, GPIO.LOW)
    GPIO.output(BIN2, GPIO.HIGH)
    GPIO.output(CIN1, GPIO.LOW)
    GPIO.output(CIN2, GPIO.HIGH)
    GPIO.output(DIN1, GPIO.LOW)
    GPIO.output(DIN2, GPIO.HIGH)
    time.sleep(t)
    motor_stop()

# 控制机器人向左转
def turn_left(t):
    GPIO.output(AIN1, GPIO.LOW)
    GPIO.output(AIN2, GPIO.HIGH)
    GPIO.output(BIN1, GPIO.HIGH)
    GPIO.output(BIN2, GPIO.LOW)
    GPIO.output(CIN1, GPIO.LOW)
    GPIO.output(CIN2, GPIO.HIGH)
    GPIO.output(DIN1, GPIO.HIGH)
    GPIO.output(DIN2, GPIO.LOW)
    time.sleep(t)
    motor_stop()

# 控制机器人向右转
def turn_right(t):
    GPIO.output(AIN1, GPIO.HIGH)
    GPIO.output(AIN2, GPIO.LOW)
    GPIO.output(BIN1, GPIO.LOW)
    GPIO.output(BIN2, GPIO.HIGH)
    GPIO.output(CIN1, GPIO.HIGH)
    GPIO.output(CIN2, GPIO.LOW)
    GPIO.output(DIN1, GPIO.LOW)
    GPIO.output(DIN2, GPIO.HIGH)
    time.sleep(t)
    motor_stop()

# 主程序
if __name__ == '__main__':
    init()
    move_forward(2)    # 向前移动2秒
    turn_left(1)       # 向左转1秒
    move_backward(2)   # 后退2秒
    turn_right(1)      # 向右转1秒
    GPIO.cleanup()

请注意，以上代码是一个简单的示例，你可能需要根据你的具体硬件配置和电机的引脚定义进行相应的修改。另外，你需要确保已经安装了RPi.GPIO库。