• 大小: 2KB
    文件类型: .py
    金币: 1
    下载: 0 次
    发布日期: 2021-05-28
  • 语言: Python
  • 标签: python  树莓派  

资源简介

树莓派小车通过超声波来进行避障,控制四个电机,能够有效避障,

资源截图

代码片段和文件信息

import  RPi.GPIO as GPIO
import time
GPIO.setmode(GPIO.BOARD)

m1_fwd = 12
m1_rev = 11
m2_fwd = 13
m2_rev = 15
red_left = 07
red_right = 16
trip = 38
echo = 37
def init():
    GPIO.setup(m1_fwdGPIO.OUT)
    GPIO.setup(m1_revGPIO.OUT)
    GPIO.setup(m2_fwdGPIO.OUT)
    GPIO.setup(m2_revGPIO.OUT)
def stop():
    GPIO.output(m1_fwdFalse)
    GPIO.output(m1_revFalse)
    GPIO.output(m2_fwdFalse)
    GPIO.output(m2_revFalse)
    GPIO.cleanup()
def fwd():
    GPIO.output(m1_fwdGPIO.HIGH)
    GPIO.output(m1_revGPIO.LOW)
    GPIO.output(m2_fwdGPIO.HIGH)
    GPIO.output(m2_revGPIO.LOW)
    GPIO.cleanup()
def rev():
    GPIO.output(m1_fwdGPIO.LOW)
    GPIO.output(m1_revGPIO.HIGH)
    GPIO.output(m2_fwdGPIO.LOW)
    GPIO.output(m2_revGPIO.HIGH)
    GPIO.cleanup()
def right():
    GPIO.output(m1_fwdGPIO.HIGH)
    GPIO.output(m1_revGPIO.LOW)
    GPIO.output(m2_fwdFalse)
    GPIO.output(m2_revFalse)
    GPIO.cleanup()

评论

共有 条评论