利用树莓派和神经网络,实现智能小车

大众实习任务
修改英伟达的端对端神经网络,在树莓派上实现智能小车
1.图像处理

# -*- coding: utf-8 -*-
"""
Created on Tue Jul 17 13:38:23 2018

@author: 51207
"""

import os
from PIL import Image
import numpy as np
import xlrd
import pickle

def loadimg_infile(imgdir):
    imgname=[]
    imgname_sorted=[]
    filename=os.listdir(imgdir)
    for file in filename:
        if 'jpg' in file:
            imgname.append(imgdir+file)
    s=len(imgname)
    for i in range(s):
        imgname_sorted.append(imgdir+'/img_'+str(i)+'.jpg')
    return imgname_sorted


def imglist_to_nparray(imglist):
    result=np.zeros((len(imglist),90,160,3),dtype=np.uint8)
    i=0
    for img in imglist:
        image=np.array(Image.open(img))
        result[i]=image
        i+=1
    return result

imgdir='D:/mywork/aidrive/intern/smallcar/data/shoudong/image3'
x=loadimg_infile(imgdir)
X=imglist_to_nparray(x)
ydata=imgdir+'/ydata.xlsx'
workbook=xlrd.open_workbook(ydata)
sheet=workbook.sheet_by_name('Sheet1')
Y=np.array(sheet.col_values(0),dtype=np.uint8)

with open('datashoudong3.pkl','wb') as fp:
    pickle.dump([X,Y],fp)      

2.模型训练

# -*- coding: utf-8 -*-
"""
Created on Tue Jul  3 10:43:21 2018

@author: 51207
"""

import os
import pickle
import matplotlib
from matplotlib.pyplot import imshow

file_path="D:/mywork/aidrive/intern/smallcar/data/alldata.pkl"

#提取数据
with open(file_path,'rb') as f:
    X,Y=pickle.load(f)

#划分数据集
import numpy as np

def unison_shuffled_copies(X,Y):
    assert len(X)==len(Y)
    p=np.random.permutation(len(X))
    return X[p], Y[p]

shuffled_X,shuffled_Y=unison_shuffled_copies(X,Y)

test_cutoff=int(len(X)* .8)
val_cutoff=test_cutoff+int(len(X)* .1)
train_X,train_Y=shuffled_X[:test_cutoff],shuffled_Y[:test_cutoff]
val_X, val_Y = shuffled_X[test_cutoff:val_cutoff], shuffled_Y[test_cutoff:val_cutoff]
test_X, test_Y = shuffled_X[val_cutoff:], shuffled_Y[val_cutoff:]

'''
#增强训练集
X_flipped = np.array([np.fliplr(i) for i in train_X])
Y_flipped = np.array([-i for i in train_Y])
train_X = np.concatenate([train_X, X_flipped])
train_Y = np.concatenate([train_Y, Y_flipped])
'''

#建模型
from keras.models import Model, load_model
from keras.layers import Input, Convolution2D, MaxPooling2D, Activation, Dropout, Flatten, Dense
img_in=Input(shape=(90,160,3),name='img_in')
angle_in=Input(shape=(1,),name='angle_in')

x=Convolution2D(8,3,3)(img_in)
x=Activation('relu')(x)
x=MaxPooling2D(pool_size=(2,2))(x)

x=Convolution2D(16,3,3)(x)
x=Activation('relu')(x)
x=MaxPooling2D(pool_size=(2,2))(x)

x=Convolution2D(32,3,3)(x)
x=Activation('relu')(x)
x=MaxPooling2D(pool_size=(2,2))(x)

merged=Flatten()(x)

x=Dense(256)(merged)
x=Activation('linear')(x)
x=Dropout(.2)(x)

angle_out=Dense(1,name='angle_out')(x)

model=Model(input=[img_in],output=[angle_out])
model.compile(optimizer='adam',loss='mean_squared_error')
model.summary()

from keras import callbacks

model_path = os.path.expanduser('~/best_autopilot.hdf5')
save_best = callbacks.ModelCheckpoint(model_path, monitor='val_loss', verbose=1,save_best_only=True, mode='min')
early_stop = callbacks.EarlyStopping(monitor='val_loss', min_delta=0, patience=5,verbose=0, mode='auto')
callbacks_list = [save_best, early_stop]
model.fit(train_X, train_Y, batch_size=50, nb_epoch=20, validation_data=(val_X, val_Y), callbacks=callbacks_list)

import pandas as pd

model = load_model(model_path)
test_P = model.predict(test_X)
test_P = test_P.reshape((test_P.shape[0],)) 

df = pd.DataFrame({'predicted':test_P, 'actual':test_Y})
ax = df.plot.scatter('predicted', 'actual')

P = model.predict(X[:150])
#predict outputs nested arrays so we need to reshape to plot.
P = P.reshape((P.shape[0],)) 

ax = pd.DataFrame({'predicted':P, 'actual':Y[:150]}).plot()
ax.set_ylabel("steering angle")

3.树莓派上运行

# -*- coding: utf-8 -*  
import RPi.GPIO as GPIO
GPIO.setmode(GPIO.BOARD)
GPIO.setup(32, GPIO.IN)                          # right US Echo
GPIO.setup(36, GPIO.OUT)                         # right US Trig
GPIO.setup(15, GPIO.IN)                          # front US Echo
GPIO.setup(38, GPIO.OUT)                         # front US Trig
GPIO.setup(37, GPIO.OUT,initial = GPIO.HIGH)     # red1
GPIO.setup(35, GPIO.OUT,initial = GPIO.HIGH)     # red2
GPIO.setup(33, GPIO.OUT,initial = GPIO.LOW)      # yellow_right
GPIO.setup(31, GPIO.OUT,initial = GPIO.LOW)      # yellow_left
GPIO.setup(11, GPIO.OUT,initial = GPIO.HIGH)     # Beep
from picamera.array import PiRGBArray
from picamera import PiCamera
import serial  
import time
import cv2
import numpy as np
from keras.models import load_model

ser = serial.Serial("/dev/ttyUSB0", 9600)

def set_picamera():
    camera = PiCamera()
    camera.resolution = (640,360)
    camera.framerate = 30
    camera.brightness=60
    camera.shutter_speed = 10000
    camera.exposure_mode = 'night'
    camera.iso=800
    time.sleep(5)
    g = camera.awb_gains
    camera.awb_mode='off'
    camera.awb_gains = g
    rawCapture = PiRGBArray(camera,size=(640,360))
    
    return camera,rawCapture

def start_Beep():
    for i in range(0,5):
        GPIO.output(11,GPIO.LOW)
        time.sleep(0.1)
        GPIO.output(11,GPIO.HIGH)
        time.sleep(0.1)

def get_angle(imageCap):
    result=np.zeros((1,90,160,3),dtype=np.uint8)
    image=np.array(imageCap)
    result[0]=image
    return int(model.predict(result)[0])

def normalize_angle(angle):
    return (int(angle/5.0+0.5))*5

if __name__ == '__main__':
    try:
        model_path='ml_model_retrain.hdf5'
        #model_path='ml_model_pbs.hdf5'
        model = load_model(model_path)
        #start_Beep()
        camera,raw = set_picamera()
        for frame in camera.capture_continuous(raw,format = "bgr",use_video_port=True):
            img = frame.array
            imageCap = cv2.resize(img,(160,90))
            angle=get_angle(imageCap)
            #angle=normalize_angle(get_angle(imageCap))
            ser.write("1,13,"+str(angle))

    except KeyboardInterrupt:  
        if ser != None:
            str1 = "1,0,90"
            n = ser.write(str1)
            time.sleep(0.2)
            print ("\nfinish")
            ser.close()

未附上图像采集等其他程序
最终效果:
https://pan.baidu.com/s/1dZfu7dOQvmXW-ESvyUX0tQ

d1420180907_165649.gif

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 204,921评论 6 478
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 87,635评论 2 381
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 151,393评论 0 338
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 54,836评论 1 277
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 63,833评论 5 368
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 48,685评论 1 281
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 38,043评论 3 399
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 36,694评论 0 258
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 42,671评论 1 300
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 35,670评论 2 321
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 37,779评论 1 332
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 33,424评论 4 321
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 39,027评论 3 307
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 29,984评论 0 19
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 31,214评论 1 260
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 45,108评论 2 351
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 42,517评论 2 343

推荐阅读更多精彩内容