資源簡介
樹莓派小車通過超聲波來進行避障,控制四個電機,能夠有效避障,
代碼片段和文件信息
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()
評論
共有 條評論