




import RPi.GPIO as GPIO
import time IN1 = 40 # pin40
IN2 = 38
IN3 = 36
IN4 = 35 def setStep(w1, w2, w3, w4): GPIO.output(IN1, w1) GPIO.output(IN2, w2) GPIO.output(IN3, w3) GPIO.output(IN4, w4) def stop(): setStep(0, 0, 0, 0) def forward(delay, steps): for i in range(0, steps): setStep(1, 0, 1, 0) time.sleep(delay) setStep(0, 1, 1, 0) time.sleep(delay) setStep(0, 1, 0, 1) time.sleep(delay) setStep(1, 0, 0, 1) time.sleep(delay) def backward(delay, steps): for i in range(0, steps): setStep(1, 0, 0, 1) time.sleep(delay) setStep(0, 1, 0, 1) time.sleep(delay) setStep(0, 1, 1, 0) time.sleep(delay) setStep(1, 0, 1, 0) time.sleep(delay) def setup(): GPIO.setwarnings(False) GPIO.setmode(GPIO.BOARD) # Numbers GPIOs by physical location GPIO.setup(IN1, GPIO.OUT) # Set pin's mode is output GPIO.setup(IN2, GPIO.OUT) GPIO.setup(IN3, GPIO.OUT) GPIO.setup(IN4, GPIO.OUT) def loop(): while True: print ("backward...") backward(0.00003, 1000) #0.00003為發射脈沖的時間間隔,單位為秒,1000代表發射脈沖的個數 print ("stop...") stop() # stop time.sleep(3) # sleep 3s print ("forward...") forward(0.00005, 1000) print ("stop...") stop() time.sleep(3) def destroy(): GPIO.cleanup() # 釋放資料 if __name__ == '__main__': # Program start from here setup() try: loop() except KeyboardInterrupt: # When 'Ctrl+C' is pressed, the child function destroy() will be executed. destroy()
原文:https://blog.csdn.net/weixin_44524040/article/details/90237127
轉載請註明出處,本文鏈接:https://www.uj5u.com/qita/144805.html
