久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: Micropython實例之DIY超聲波避障小車 [打印本頁]
作者: bodasister    時間: 2018-6-5 10:25
標題: Micropython實例之DIY超聲波避障小車
    當今發達的交通在給人們帶來便捷的同時也帶來了許多的交通事故。人們遇到緊急事情處理超時是造成因素的主要原因之一。如果我們的汽車更加智能，事先能預測并顯示前面障礙物距離車的距離，當障礙物距離車很近的時候自動采取一些措施來避開障礙物，這樣就能在很大程度上避免事故的發生，下面我來帶大家做一個智能的避障小車。
下方可查看演示視頻！

    一、實驗器材

    1、TPYboard V102板  1塊
    2、電機驅動模塊L298N   1個
    3、電機 2塊
    4、小車底盤 1個
    5、超聲波模塊 1個
    6、舵機 1個
    7、SG90舵機支架 1個
    8、超聲波云臺支架 1個



    二、超聲波模塊

    什么是超聲波模塊

    超聲波傳感器是利用超聲波的特性研制而成的傳感器, 它是通過傳送一個超聲波（遠高于人的聽覺范圍）和提供一個對應于爆裂回聲返回到傳感器所需時間的輸出脈沖來工作的。超聲波傳感器在非接觸性測量方面的應用非常廣泛，如檢測液體水位（特別是具有腐蝕性的液體，如硫酸、硝酸液體），汽車倒車防撞系統，金屬/非金屬探傷等，都可以用到超聲波距離傳感器。

    超聲波模塊測距的原理

    采用IO口TRIG觸發測距，給最少10us的高電平信呈。
    模塊自動發送 8 個 40khz 的方波，自動檢測是否有信號返回。

    (3)有信號返回，通過 IO 口 ECHO 輸出一個高電平，高電平持續的時間就是超聲波從發射到返回的時間。測試距離=(高電平時間*聲速(340M/S))/2。
    如下圖接線，VCC 供 5V電源， GND 為地線，TRIG 觸發控制信號輸入，接板子的X9，ECHO 回響信號輸出，接板子的X10，四個接口端。




    三、電機驅動模塊

    什么是電機驅動模塊

    電機驅動模塊主要是可以控制電機的運行：調速、運行、停止、步進、勻速等操作。

    L298N的使用方法

    L298N模塊是2路的H橋驅動，所以可以同時驅動兩個電機，接法如圖所示使能ENA ENB之后，可以分別從IN1 IN2輸入PWM信號驅動電機1的轉速和方向，可以分別從IN3 IN4輸入PWM信號驅動電機2的轉速和方向。我們將電機1接口的OUT1與OUT2與小車的一個電機的正負極連接起來，將電機2接口的OUT3與OUT2與小車的另一個電機的正負極連接起來。然后將兩邊的接線端子，即供電正極（中間的接線端子為接地）連接TPYboard的VIN，中間的接線端子即接地，連接TPYBoard的GND，In1-In4連接TPYBoard的X1，X2，Y1，Y2，通過X1,X2與Y1,Y2的高低電平，來控制電機的轉動，從而讓小車前進，后退，向左，向右。




    四、舵機

    概述

    舵機也叫伺服電機，最早用于船舶上實現其轉向功能，由于可以通過程序連續控制其轉角，因而被廣泛應用智能小車以實現轉向以及機器人各類關節運動中，如下圖所示。




    2、舵機的組成

    一般來講，舵機主要由以下幾個部分組成，舵盤、減速齒輪組、位置反饋電位計、直流電機、控制電路等，如下圖所示。



    舵機的輸入線共有三條，紅色中間，是電源線，一邊灰色的是地線，這輛根線給舵機提供最基本的能源保證，主要是電機的轉動消耗。電源有兩種規格，一是4.8V，一是6.0V，分別對應不同的轉矩標準，即輸出力矩不同，6.0V對應的要大一些，具體看應用條件；另外一根線是控制信號線，Futaba的一般為白色，JR的一般為桔黃色。另外要注意一點，SANWA的某些型號的舵機引線電源線在邊上而不是中間，需要辨認。但記住紅色為電源，灰色為地線，剩下的一根為信號線，一般不會搞錯。本實驗中，舵機紅色接TPYBoard v102+的VIN引腳，灰色接TPYBoard v102+的GND引腳，剩下的橙色是信號線，接TPYBoard V102+的X3針腳。TPYBoard v102+ 的X1、X2、X3、X4為信號引腳。




    3、舵機工作原理

    控制電路板接受來自信號線的控制信號，控制電機轉動，電機帶動一系列齒輪組，減速后傳動至輸出舵盤。舵機的輸出軸和位置反饋電位計是相連的，舵盤轉動的同時，帶動位置反饋電位計，電位計將輸出一個電壓信號到控制電路板，進行反饋，然后控制電路板根據所在位置決定電機轉動的方向和速度，從而達到目標停止。其工作流程為：控制信號→控制電路板→電機轉動→齒輪組減速→舵盤轉動→位置反饋電位計→控制電路板反饋。

    五、伺服電機的構造函數與方法

    1.構造函數
    pyb.Servo(id)
    在這id為1-4，對應TPYBoard v102+的X1-X4。

    2.方法
    Servo.angle（[angle，time = 0 ]）
    如果沒有給出參數，則該函數返回當前角度。
    如果給出參數，則該函數設置伺服角度：

    angle 是以度數移動的角度。
    time是達到指定角度所需的毫秒數。如果省略，則伺服器盡可能快地移動到其新位置。
    Servo.speed([speed, time=0])
    如果沒有給出參數，則該函數返回當前速度。
    如果給出參數，則該功能設置伺服的速度：
    speed 是在-100到100之間變化的速度。
    time是達到指定速度所需的毫秒數。如果省略，則伺服器盡可能快地加速。
    Servo.pulse_width（[value ]） <http://docs.micropython.org/en/l ... /pyb.Servo.html>
    如果沒有給出參數，該函數返回當前的原始脈沖寬度值。
    如果給出參數，則該函數設置原始脈沖寬度值。
    Servo.calibration（[pulse_min，pulse_max，pulse_centre [，pulse_angle_90，pulse_speed_100 ]]）
    如果沒有給出參數，則該函數返回當前的校準數據，作為5元組。
    如果給出參數，該功能設置時序校準：
    pulse_min 是允許的最小脈沖寬度。
    pulse_max 是允許的最大脈沖寬度。
    pulse_centre 是對應于中心/零位置的脈沖寬度。
    pulse_angle_90 是對應于90度的脈沖寬度。
    pulse_speed_100 是對應于速度100的脈沖寬度。

    六、硬件接線圖

  
TPYBoard v102
  
超聲波模塊
舵機
L298N驅動模塊
VIN
VCC


GND
GND


X9
Trig


X10
Echo


VIN

紅

GND

灰

X3

橙

X1


In1
X2


In2
Y1


In3
Y2


In4
VIN


+12V
GND


GND
VIN


+5V


    七、實驗效果

    http://player.youku.com/player.php/sid/XMjY2MTQ1NDA2MA==/v.swf

    八、源代碼
  1. # main.py -- put your code here!
  2. import pyb
  3. from pyb import Pin
  4. from pyb import Timer
  5. from pyb import servo

  7. x1 = Pin('X1', Pin.OUT_PP)
  8. x2 = Pin('X2', Pin.OUT_PP)
  9. y1 = Pin('Y1', Pin.OUT_PP)
  10. y2 = Pin('Y2', Pin.OUT_PP)
  11. Trig = Pin('X9',Pin.OUT_PP)
  12. Echo = Pin('X10',Pin.IN)

  14. num=0
  15. flag=0
  16. run=1
  17. zuo=0
  18. qian=0
  19. you=0
  20. distance=0
  21. def start(t):
  22.     global flag
  23.     global num
  24.     if(flag==0):
  25.         num=0
  26.     else:
  27.         num=num+1
  28. def stop(t):
  29.     global run
  30.     if(run==0):
  31.         run=1
  32. start1=Timer(1,freq=10000,callback=start)
  33. stop1=Timer(4,freq=2,callback=stop)

  35. #小車左轉
  36. def left():
  37.     x1.high()
  38.     x2.low()
  39.     y1.high()
  40.     y2.low()
  41. #小車前進
  42. def go():
  43.     x1.high()
  44.     x2.low()
  45.     y1.low()
  46.     y2.high()
  47. #小車后退
  48. def back():
  49.     x1.low()
  50.     x2.high()
  51.     y1.high()
  52.     y2.low()
  53. #小車右轉
  54. def right():
  55.     x1.low()
  56.     x2.high()
  57.     y1.low()
  58.     y2.high()
  59. #小車停止
  60. def stop():
  61.     x1.low()
  62.     x2.low()
  63.     y1.low()
  64.     y2.low()
  65. #控制舵機向右、向左、向前
  66. def servo():
  67.     global distance
  68.     global zuo
  69.     global you
  70.     global qian
  71.     servo3=pyb.Servo(3)
  72.     #向右75旋轉
  73.     servo3.angle(-75,500)
  74.     pyb.delay(1000)
  75.     ceju()
  76.     you=distance
  77.     print('you',you)
  78.     #向左轉75度
  79.     servo3.angle(75,500)
  80.     pyb.delay(1000)
  81.     ceju()
  82.     zuo=distance
  83.     print('zuo',distance)
  84.     #轉到0度
  85.     servo3.angle(0,500)
  86.     pyb.delay(1000)
  87.     ceju()
  88.     qian=distance
  89.     print('qian',distance)
  90.     #返回正前方、左前方、右前方的距離
  91.     return qian,zuo,you
  92. #測距方法
  93. def  ceju():
  94.     global flag
  95.     global num
  96.     global run
  97.     global distance
  98.     if(run==1):
  99.         Trig.value(1)
  100.         pyb.udelay(100)
  101.         Trig.value(0)
  102.         while(Echo.value()==0):
  103.             Trig.value(1)
  104.             pyb.udelay(100)
  105.             Trig.value(0)
  106.             flag=0
  107.         if(Echo.value()==1):
  108.             flag=1
  109.             while(Echo.value()==1):           
  110.                 flag=1
  111.         if(num!=0):
  112.             #測距
  113.             distance=num/10000*34299/2
  114.             #print('Distance:')
  115.             #print(distance,'cm')
  116.             pyb.delay(500)
  117.         flag=0
  118.         run=0
  119.     return distance
  120. def main():
  121.     global distance
  122.     global zuo
  123.     global you
  124.     global qian
  125.     servo3=pyb.Servo(3)
  126.     servo3.angle(0,500)
  127.     pyb.delay(1000)
  128.     ceju()
  129.     while 1==1:
  130.         ceju()、
  131.         #前方距離大于40cm前進
  132.         if distance > 40:
  133.             go()
  134.             ceju()
  135.             print('juli',distance)
  136.         #前方距離小于40cm
  137.         if distance <= 40:
  138.             stop()
  139.             back()
  140.             pyb.delay(500)
  141.             stop()
  142.             servo()
  143.             #如果右前方距離大于左前方
  144.             if you>zuo:
  145.                 right()
  146.                 pyb.delay(400)
  147.                 ceju()
  148.             #如果左前方距離大于右前方
  149.             if zuo>you:
  150.                 left()
  151.                 pyb.delay(400)
  152.                 ceju()
  153.             #如果所有方向距離全部小于15cm
  154.             if zuo<15 and you< 15 and qian<15 :
  155.                 stop()
  156.                 back()
  157.                 pyb.delay(800)
  158.                 stop()
  159.                 ceju()
  160.             #有一個方向距離小于5CM
  161.             if zuo<5 or you <5 or qian<5:
  162.                 stop()
  163.                 back()
  164.                 pyb.delay(800)
  165.                 stop()
  166.                 ceju()
  167. main()
復制代碼









歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 一区二区国产精品 | 久久久久久久久蜜桃 | 国产aⅴ爽av久久久久久久 | 欧美一区二区 | 色网站视频| 午夜国产| 久久久妇女国产精品影视 | 国产精品九九九 | 国产黄色大片 | 国产精品久久国产精品 | 精品久久久久久 | 2021狠狠天天天 | www.日韩系列| 国产精品亚洲第一区在线暖暖韩国 | 91精品国产91久久久久久最新 | 精品欧美视频 | 日韩在线观看一区 | 九九热精品视频在线观看 | 玖玖玖在线观看 | 亚洲一区二区三 | 日韩一区精品 | 污视频免费在线观看 | 免费视频二区 | 精品无码久久久久久国产 | a级网站 | 久久久www成人免费精品 | 国产一级毛片视频 | 韩日一区| 免费的黄色片子 | 国产精品一区二区在线播放 | 黄a网| 福利视频亚洲 | 国产精品久久久久久久7777 | 免费看的黄网站 | 欧美男人天堂 | 日韩国产在线 | 三级黄视频在线观看 | 91精品久久 | 天堂综合网久久 | 91爱爱·com| 精品视频一区二区 |