|
智能小車(chē)作為現(xiàn)代的新發(fā)明,是以后的發(fā)展方向,他可以按照預(yù)先設(shè)定的模式在一個(gè)環(huán)境里自動(dòng)的運(yùn)作,不需要人為的管理,可應(yīng)用于科學(xué)勘探等等的用途。智能小車(chē)能夠?qū)崟r(shí)顯示時(shí)間、速度、里程,具有自動(dòng)尋跡、尋光、避障功能,可程控行駛速度、準(zhǔn)確定位停車(chē),遠(yuǎn)程傳輸圖像等功能。下面帶大家做一個(gè)智能藍(lán)牙小車(chē),用手機(jī)APP來(lái)控制小車(chē)前進(jìn)、后退、向左、向右、停止,本次藍(lán)牙小車(chē)的設(shè)計(jì)在于探索藍(lán)牙智能小車(chē)的設(shè)計(jì)理念及設(shè)計(jì)方法,學(xué)習(xí)一下PWM控制電機(jī)差速來(lái)控制小車(chē)的方向,下面就動(dòng)手搞起來(lái)吧。。。!
1.效果展示
給大家上視頻連接,可以藍(lán)牙控制,可以手柄控制哦
https://v.qq.com/x/page/k0721or47dw.html
2.材料準(zhǔn)備
TPYBoard v102 1塊
藍(lán)牙串口模塊 1個(gè)
TPYBoard v102小車(chē)擴(kuò)展板(包含4個(gè)車(chē)輪,4個(gè)電機(jī))
18650電池 2節(jié)
數(shù)據(jù)線 1條
杜邦線 若干
藍(lán)牙APP (http://old點(diǎn)tpyboard點(diǎn)com/download/tool/190.html)
3.藍(lán)牙模塊
藍(lán)牙( Bluetooth):是一種無(wú)線技術(shù)標(biāo)準(zhǔn),可實(shí)現(xiàn)固定設(shè)備、移動(dòng)設(shè)備和樓宇個(gè)人域網(wǎng)之間的短距離數(shù)據(jù)交換(使用2.4-2.485GHz的ISM波段的UHF無(wú)線電波)。
我們?cè)诖耸褂玫乃{(lán)牙模塊(HC-06)已經(jīng)在內(nèi)部實(shí)現(xiàn)了藍(lán)牙協(xié)議,不用我們?cè)偃プ约洪_(kāi)發(fā)調(diào)試協(xié)議。這類(lèi)模塊一般都是借助于串口協(xié)議通信,因此我們只需借助串口將我們需要發(fā)送的數(shù)據(jù)發(fā)送給藍(lán)牙模塊,藍(lán)牙模塊會(huì)自動(dòng)將數(shù)據(jù)通過(guò)藍(lán)牙協(xié)議發(fā)送給配對(duì)好的藍(lán)牙設(shè)備。
1.png (181.37 KB, 下載次數(shù): 39)
下載附件
2018-7-19 15:42 上傳
4.單片機(jī)-TPYBoard v102
TPYBoard v102 是遵循MIT協(xié)議,由TurnipSmart公司制作的一款MicroPython開(kāi)發(fā)板,它基于STM32F405單片機(jī),通過(guò)USB接口進(jìn)行數(shù)據(jù)傳輸。該開(kāi)發(fā)板內(nèi)置4個(gè)LED燈、一個(gè)加速度傳感器,可在3V-10V之間的電壓正常工作。讓你會(huì)Python就能做極客, 用Python控制硬件,支持Python語(yǔ)言的開(kāi)發(fā)板。比樹(shù)莓派更小巧,更簡(jiǎn)單,更便宜,比Arduino更強(qiáng)大,更加容易編程。
QQ圖片20180719153905.png (337.4 KB, 下載次數(shù): 53)
下載附件
2018-7-19 15:42 上傳
小車(chē)擴(kuò)展板
以TPYBoard v102開(kāi)發(fā)板為主控板,小車(chē)擴(kuò)展板具有四路PWM調(diào)速電機(jī)、8個(gè)可控LED、1個(gè)蜂鳴器、5路舵機(jī)接口、1個(gè)藍(lán)牙接口、1個(gè)PS2無(wú)線接口、引出TPYBoard v102開(kāi)發(fā)板全部針腳,可裝載循跡模塊、超聲波模塊、機(jī)械手臂、紅外接收頭,兼容入門(mén)級(jí)電機(jī)和專(zhuān)業(yè)級(jí)電機(jī),兩節(jié)18650單獨(dú)供電。
3.png (6.37 MB, 下載次數(shù): 45)
下載附件
2018-7-19 15:42 上傳
源代碼
我們只需要把TPYBoard v102 插小車(chē)擴(kuò)展板上,把藍(lán)牙模塊插上,把程序?qū)懭刖托?下面是main.py源程序
- # main.py -- put your code here!
- from pyb import Pin
- from pyb import UART
- N1 = Pin('Y1', Pin.OUT_PP)
- N2 = Pin('Y2', Pin.OUT_PP)
- N3 = Pin('Y3', Pin.OUT_PP)
- N4 = Pin('Y4', Pin.OUT_PP)
- N5 = Pin('Y6', Pin.OUT_PP)
- N6 = Pin('Y7', Pin.OUT_PP)
- N7 = Pin('Y8', Pin.OUT_PP)
- N8 = Pin('Y9', Pin.OUT_PP)
- led_red=Pin('Y5', Pin.OUT_PP)
- led_right=Pin('Y12', Pin.OUT_PP)
- led_left=Pin('Y11', Pin.OUT_PP)
- led_red.value(1)
- led_right.value(0)
- led_left.value(0)
- blue=UART(1,9600,timeout=100)
- def go(speed):
- M1_0=pyb.Timer(8, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y1, pulse_width=(speed*200)+10000)
- M1_1=pyb.Timer(8, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y2, pulse_width=0)
- M2_0=pyb.Timer(4, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y3, pulse_width=(speed*100)+5000)
- M2_1=pyb.Timer(4, freq=10000).channel(4, pyb.Timer.PWM, pin=pyb.Pin.board.Y4, pulse_width=0)
- M3_0=pyb.Timer(1, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y6, pulse_width=(speed*220)+10000)
- M3_1=pyb.Timer(1, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y7, pulse_width=0)
- M4_0=pyb.Timer(2, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y9, pulse_width=(speed*50)+5000)
- M4_1=pyb.Timer(12, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y8, pulse_width=0)
-
- led_red.value(0)
-
- def back(speed):
- M1_0=pyb.Timer(8, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y1, pulse_width=0)
- M1_1=pyb.Timer(8, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y2, pulse_width=(speed*200)+10000)
- M2_0=pyb.Timer(4, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y3, pulse_width=0)
- M2_1=pyb.Timer(4, freq=10000).channel(4, pyb.Timer.PWM, pin=pyb.Pin.board.Y4, pulse_width=(speed*100)+10000)
- M3_0=pyb.Timer(1, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y6, pulse_width=0)
- M3_1=pyb.Timer(1, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y7, pulse_width=(speed*200)+10000)
- M4_0=pyb.Timer(2, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y9, pulse_width=0)
- M4_1=pyb.Timer(12, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y8, pulse_width=(speed*100)+10000)
-
- led_red.value(1)
- def stop():
- M1_0=pyb.Timer(8, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y1, pulse_width=0)
- M1_1=pyb.Timer(8, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y2, pulse_width=0)
- M2_0=pyb.Timer(4, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y3, pulse_width=0)
- M2_1=pyb.Timer(4, freq=10000).channel(4, pyb.Timer.PWM, pin=pyb.Pin.board.Y4, pulse_width=0)
- M3_0=pyb.Timer(1, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y6, pulse_width=0)
- M3_1=pyb.Timer(1, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y7, pulse_width=0)
- M4_0=pyb.Timer(12, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y8, pulse_width=0)
- M4_1=pyb.Timer(2, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y9, pulse_width=0)
- led_right.value(0)
- led_left.value(0)
- led_red.value(1)
-
- def left(speed):
- M1_0=pyb.Timer(8, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y1, pulse_width=(speed*30)+10000)
- M1_1=pyb.Timer(8, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y2, pulse_width=0)
- M2_0=pyb.Timer(4, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y3, pulse_width=(speed*100)+10000)
- M2_1=pyb.Timer(4, freq=10000).channel(4, pyb.Timer.PWM, pin=pyb.Pin.board.Y4, pulse_width=0)
- M3_0=pyb.Timer(1, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y6, pulse_width=(speed*30)+10000)
- M3_1=pyb.Timer(1, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y7, pulse_width=0)
- M4_0=pyb.Timer(2, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y9, pulse_width=(speed*100)+10000)
- M4_1=pyb.Timer(12, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y8, pulse_width=0)
- led_right.value(1)
- led_left.value(0)
-
- def right(speed):
- M1_0=pyb.Timer(8, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y1, pulse_width=(speed*200)+20000)
- M1_1=pyb.Timer(8, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y2, pulse_width=0)
- M2_0=pyb.Timer(4, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y3, pulse_width=(speed*200)+3000)
- M2_1=pyb.Timer(4, freq=10000).channel(4, pyb.Timer.PWM, pin=pyb.Pin.board.Y4, pulse_width=0)
- M3_0=pyb.Timer(1, freq=10000).channel(1, pyb.Timer.PWM, pin=pyb.Pin.board.Y6, pulse_width=(speed*100)+20000)
- M3_1=pyb.Timer(1, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y7, pulse_width=0)
- M4_0=pyb.Timer(2, freq=10000).channel(3, pyb.Timer.PWM, pin=pyb.Pin.board.Y9, pulse_width=(speed*100)+3000)
- M4_1=pyb.Timer(12, freq=10000).channel(2, pyb.Timer.PWM, pin=pyb.Pin.board.Y8, pulse_width=0)
- led_right.value(0)
- led_left.value(1)
- while True:
- if blue.any()>0:
- data=blue.read().decode()
- print(data)
- if data.find('0')>-1:
- #stop
- stop()
- print('stop')
- if data.find('1')>-1:
- pyb.LED(2).on()
- pyb.LED(3).off()
- pyb.LED(4).off()
- #-------------
- go(5)
- print('go')
- if data.find('2')>-1:
- pyb.LED(2).off()
- pyb.LED(3).on()
- pyb.LED(4).off()
- #-------------
- back(5)
- if data.find('3')>-1:
- pyb.LED(2).off()
- pyb.LED(3).off()
- pyb.LED(4).on()
- left(5)
- if data.find('4')>-1:
- pyb.LED(2).off()
- pyb.LED(3).off()
- pyb.LED(4).on()
- right(5)
復(fù)制代碼
|
|