【樹莓派】樹莓派小車(三)Python控制小車

正文之前

由于最近忙于復習趕考,所以暫時沒有拿起樹莓派小車,直到昨天,終于空出時間來把代碼整理一下來和大家分享。


正文

樹莓派小車系列之二中,講到了樹莓派的引腳定義方式有兩種:

  • PHYSICAL NUMBERING
  • GPIO NUMBERING

我采用的是第二種方式。

開始寫

1. 導入庫
import RPi.GPIO as GPIO
import time
2. 定義接口方式以及接口位置
GPIO.setmode(GPIO.BCM)
IN1 = 17
IN2 = 18
IN3 = 27
IN4 = 22
IN5 = 23
IN6 = 24 

IN1 - IN4為L298N接入,IN5和IN6為紅外線模塊接入。

車輪驅動方式:

IN1和IN2負責驅動車輪轉動(前進)。
IN3和IN4負責驅動車輪轉動(后退)。

3. 初始化
def init():
    GPIO.setup(IN1, GPIO.OUT)
    GPIO.setup(IN2, GPIO.OUT)
    GPIO.setup(IN3, GPIO.OUT)
    GPIO.setup(IN4, GPIO.OUT)
    GPIO.setup(IN5, GPIO.IN)
    GPIO.setup(IN6, GPIO.IN)

連接L298N的接口設為輸出,因為需要輸出的信號來驅動電機。
連接紅外線模塊的接口為輸入,因為需要輸入的信號來做出判斷。

4. 基礎方向行為
def up():
    GPIO.output(IN1, GPIO.HIGH)          //右側車輪前進
    GPIO.output(IN2, GPIO.HIGH)          //左側車輪前進
    GPIO.output(IN3, GPIO.LOW)
    GPIO.output(IN4, GPIO.LOW)


def down():
    GPIO.output(IN1, GPIO.LOW)
    GPIO.output(IN2, GPIO.LOW)
    GPIO.output(IN3, GPIO.HIGH)          //右側車輪后退
    GPIO.output(IN4, GPIO.HIGH)          //左側車輪后退


def turn_left():
    GPIO.output(IN1, GPIO.HIGH)          //右側車輪前進
    GPIO.output(IN2, GPIO.LOW)
    GPIO.output(IN3, GPIO.LOW)
    GPIO.output(IN4, GPIO.LOW)


def turn_right():
    GPIO.output(IN1, GPIO.LOW)
    GPIO.output(IN2, GPIO.HIGH)          //左側車輪前進
    GPIO.output(IN3, GPIO.LOW)
    GPIO.output(IN4, GPIO.LOW)

需要說明的是:由于不含舵機,轉彎的操作是單邊車輪驅動,帶動車身轉動

5. 紅外控制
init()

n = 5

while (n > 0):                                  //總共轉彎五次
    in_left = GPIO.input(IN5)                   //左側紅外線接收器
    in_right = GPIO.input(IN6)                  //右側紅外線接收器
    up()                                        //未遇到障礙時直行
    if (in_left == GPIO.LOW):
        down()
        time.sleep(1)
        turn_right()
        time.sleep(1)
        n = n - 1
        continue
    
    if (in_right == GPIO.LOW):
        down()
        time.sleep(1)
        turn_left()
        time.sleep(1)
        n = n - 1
        continue
    
    if (in_right == GPIO.LOW & in_left == GPIO.LOW):
        down()
        time.sleep(1)
        turn_right()               //如果兩側都有障礙,就右轉(個人喜好)
        time.sleep(1)
        n = n - 1
        continue

stop()                      
GPIO.cleanup()                    //清空GPIO接口配置信息

如果前方遇到障礙,就后退一秒,然后轉彎,最后繼續直行,直到遇到下一個障礙。

需要說明的是time.sleep()的用法:
time.sleep(time) 表示的是經過 time 秒后執行下一步操作,就是休眠一段時間的意思。
如果不使用time.sleep(),將會一直執行第一步操作。

關于運行:

  • 由于紅外傳感器的有效距離偏短(5cm左右),以及傳感器的安裝位置在車的底部,所以在車輛運動時,如果遇到凹凸不平的物體,有可能造成避障的延遲。

運行視頻

樹莓派小車

遇到凹凸不平的物體有些許碰撞(環境簡陋)

關于樹莓派信息的內容就先告一段落,等我做出安卓遙控app再來介紹,謝謝大家的關注。

最后編輯于
?著作權歸作者所有,轉載或內容合作請聯系作者
  • 序言:七十年代末,一起剝皮案震驚了整個濱河市,隨后出現的幾起案子,更是在濱河造成了極大的恐慌,老刑警劉巖,帶你破解...
    沈念sama閱讀 227,283評論 6 530
  • 序言:濱河連續發生了三起死亡事件,死亡現場離奇詭異,居然都是意外死亡,警方通過查閱死者的電腦和手機,發現死者居然都...
    沈念sama閱讀 97,947評論 3 413
  • 文/潘曉璐 我一進店門,熙熙樓的掌柜王于貴愁眉苦臉地迎上來,“玉大人,你說我怎么就攤上這事。” “怎么了?”我有些...
    開封第一講書人閱讀 175,094評論 0 373
  • 文/不壞的土叔 我叫張陵,是天一觀的道長。 經常有香客問我,道長,這世上最難降的妖魔是什么? 我笑而不...
    開封第一講書人閱讀 62,485評論 1 308
  • 正文 為了忘掉前任,我火速辦了婚禮,結果婚禮上,老公的妹妹穿的比我還像新娘。我一直安慰自己,他們只是感情好,可當我...
    茶點故事閱讀 71,268評論 6 405
  • 文/花漫 我一把揭開白布。 她就那樣靜靜地躺著,像睡著了一般。 火紅的嫁衣襯著肌膚如雪。 梳的紋絲不亂的頭發上,一...
    開封第一講書人閱讀 54,817評論 1 321
  • 那天,我揣著相機與錄音,去河邊找鬼。 笑死,一個胖子當著我的面吹牛,可吹牛的內容都是我干的。 我是一名探鬼主播,決...
    沈念sama閱讀 42,906評論 3 440
  • 文/蒼蘭香墨 我猛地睜開眼,長吁一口氣:“原來是場噩夢啊……” “哼!你這毒婦竟也來了?” 一聲冷哼從身側響起,我...
    開封第一講書人閱讀 42,039評論 0 285
  • 序言:老撾萬榮一對情侶失蹤,失蹤者是張志新(化名)和其女友劉穎,沒想到半個月后,有當地人在樹林里發現了一具尸體,經...
    沈念sama閱讀 48,551評論 1 331
  • 正文 獨居荒郊野嶺守林人離奇死亡,尸身上長有42處帶血的膿包…… 初始之章·張勛 以下內容為張勛視角 年9月15日...
    茶點故事閱讀 40,502評論 3 354
  • 正文 我和宋清朗相戀三年,在試婚紗的時候發現自己被綠了。 大學時的朋友給我發了我未婚夫和他白月光在一起吃飯的照片。...
    茶點故事閱讀 42,662評論 1 366
  • 序言:一個原本活蹦亂跳的男人離奇死亡,死狀恐怖,靈堂內的尸體忽然破棺而出,到底是詐尸還是另有隱情,我是刑警寧澤,帶...
    沈念sama閱讀 38,188評論 5 356
  • 正文 年R本政府宣布,位于F島的核電站,受9級特大地震影響,放射性物質發生泄漏。R本人自食惡果不足惜,卻給世界環境...
    茶點故事閱讀 43,907評論 3 345
  • 文/蒙蒙 一、第九天 我趴在偏房一處隱蔽的房頂上張望。 院中可真熱鬧,春花似錦、人聲如沸。這莊子的主人今日做“春日...
    開封第一講書人閱讀 34,304評論 0 25
  • 文/蒼蘭香墨 我抬頭看了看天上的太陽。三九已至,卻和暖如春,著一層夾襖步出監牢的瞬間,已是汗流浹背。 一陣腳步聲響...
    開封第一講書人閱讀 35,563評論 1 281
  • 我被黑心中介騙來泰國打工, 沒想到剛下飛機就差點兒被人妖公主榨干…… 1. 我叫王不留,地道東北人。 一個月前我還...
    沈念sama閱讀 51,255評論 3 389
  • 正文 我出身青樓,卻偏偏與公主長得像,于是被迫代替她去往敵國和親。 傳聞我的和親對象是個殘疾皇子,可洞房花燭夜當晚...
    茶點故事閱讀 47,637評論 2 370

推薦閱讀更多精彩內容