raspberry pi2 智能小车源码及测试视频

作者：XIAOBO QQ：463431476

转载请注明作者
Python 源代码

import RPi.GPIO as GPIO 

#human-computer-interaction

import curses 

 

import time

 

from curses import wrapper 

 

 

GPIO.setmode(GPIO.BCM) 

 

 

#left_moto_go

GPIO.setup(27, GPIO.OUT) #IN1

 

GPIO.setup(18, GPIO.OUT) #IN3

#left_moto_back

GPIO.setup(12,GPIO.OUT)#IN2

 

GPIO.setup(25,GPIO.OUT)#IN4

 

 

 

#right_moto_go

GPIO.setup(22, GPIO.OUT) #IN5

 

GPIO.setup(23, GPIO.OUT) #IN7

#right_moto_back

GPIO.setup(17,GPIO.OUT)#IN6

 

GPIO.setup(8,GPIO.OUT)#IN8

 

stdscr = curses.initscr() 

 

stdscr.clear() 

 

 

 

while True: 

 

    ch = stdscr.getkey()

 

 

 

#EXIT

 

    if ch == 'e':

        curses.endwin()

         

        break

 

 

# Forward 

 

    if ch == 'w': 

 

       GPIO.output(27,GPIO.HIGH) 

 

       GPIO.output(18,GPIO.HIGH)

       

       GPIO.output(12,GPIO.LOW)

 

       GPIO.output(25,GPIO.LOW)

 

       GPIO.output(22,GPIO.HIGH) 

 

       GPIO.output(23,GPIO.HIGH)

 

       GPIO.output(17,GPIO.LOW)

 

       GPIO.output(8,GPIO.LOW)

 

       time.sleep(0.3)

       

       GPIO.output(27,GPIO.LOW) 

 

       GPIO.output(18,GPIO.LOW) 

 

       GPIO.output(22,GPIO.LOW)  

       

       GPIO.output(23,GPIO.LOW) 

 

       GPIO.output(12,GPIO.LOW)

 

       GPIO.output(25,GPIO.LOW)

 

       GPIO.output(17,GPIO.LOW)

 

       GPIO.output(8,GPIO.LOW)

 

# Backward 

 

    if ch == 's': 

 

        GPIO.output(27,GPIO.LOW) 

 

        GPIO.output(18,GPIO.LOW) 

 

        GPIO.output(12,GPIO.HIGH)

 

        GPIO.output(25,GPIO.HIGH)

 

        GPIO.output(17,GPIO.HIGH)

 

        GPIO.output(8,GPIO.HIGH)

 

        GPIO.output(22,GPIO.LOW)  

       

        GPIO.output(23,GPIO.LOW)

 

        time.sleep(0.3)

       

        GPIO.output(27,GPIO.LOW) 

 

        GPIO.output(18,GPIO.LOW) 

 

        GPIO.output(22,GPIO.LOW)  

       

        GPIO.output(23,GPIO.LOW) 

 

        GPIO.output(12,GPIO.LOW)

 

        GPIO.output(25,GPIO.LOW)

 

        GPIO.output(17,GPIO.LOW)

 

        GPIO.output(8,GPIO.LOW)

        

 

# Turn Right 

 

    if ch == 'd': 

 

       GPIO.output(27,GPIO.HIGH) 

 

       GPIO.output(18,GPIO.HIGH)

 

       GPIO.output(12,GPIO.LOW)

 

       GPIO.output(25,GPIO.LOW)

 

       GPIO.output(17,GPIO.HIGH) 

 

       GPIO.output(8,GPIO.HIGH) 

 

       GPIO.output(22,GPIO.LOW)  

       

       GPIO.output(23,GPIO.LOW) 

 

       time.sleep(0.3)

       

       GPIO.output(27,GPIO.LOW) 

 

       GPIO.output(18,GPIO.LOW) 

 

       GPIO.output(22,GPIO.LOW)  

       

       GPIO.output(23,GPIO.LOW) 

 

       GPIO.output(12,GPIO.LOW)

 

       GPIO.output(25,GPIO.LOW)

 

       GPIO.output(17,GPIO.LOW)

 

       GPIO.output(8,GPIO.LOW)

 

# Turn Left 

 

    if ch == 'a': 

 

       GPIO.output(22,GPIO.HIGH) 

 

       GPIO.output(23,GPIO.HIGH)

       

       GPIO.output(17,GPIO.LOW)

 

       GPIO.output(8,GPIO.LOW)

 

       GPIO.output(12,GPIO.HIGH) 

 

       GPIO.output(25,GPIO.HIGH)

       

       GPIO.output(27,GPIO.LOW) 

 

       GPIO.output(18,GPIO.LOW) 

 

       time.sleep(0.3)

       

       GPIO.output(27,GPIO.LOW) 

 

       GPIO.output(18,GPIO.LOW) 

 

       GPIO.output(22,GPIO.LOW)  

       

       GPIO.output(23,GPIO.LOW) 

 

       GPIO.output(12,GPIO.LOW)

 

       GPIO.output(25,GPIO.LOW)

 

       GPIO.output(17,GPIO.LOW)

 

       GPIO.output(8,GPIO.LOW)

 

 

 

 

   下面是测试视频