OpenVINOTM,给你看得见的未来!>>
电子产品世界 » 论坛首页 » 嵌入式开发 » STM32 » [TPYBoard-Micropython之会python就能做硬件 8] 学习

共4条 1/1 1 跳转至

[TPYBoard-Micropython之会python就能做硬件 8] 学习使用超声波模块制作避障小车

菜鸟
2017-03-25 11:34:25    评分
    一、实验器材
1、TPYboard V102板  一块
2、电机驱动模块L298N   一个
3、电机 两块
4、小车底盘
5、超声波模块
6、5110屏  一块
二、超声波模块
1、什么是超声波模块

超声波传感器是利用超声波的特性研制而成的传感器, 它是通过传送一个超声波(远高于人的听觉范围)和提供一个对应于爆裂回声返回到传感器所需时间的输出脉冲来工作的。超声波传感器在非接触性测量方面的应用非常广泛,如检测液体水位(特别是具有腐蚀性的液体,如硫酸、硝酸液体),汽车倒车防撞系统,金属/非金属探伤等,都可以用到超声波距离传感器。

2、超声波模块测距的原理

采用IO口TRIG触发测距,给最少10us的高电平信呈。
模块自动发送 8 个 40khz 的方波,自动检测是否有信号返回。
(3)有信号返回,通过 IO 口 ECHO 输出一个高电平,高电平持续的时间就是超声波从发射到返回的时间。测试距离=(高电平时间*声速(340M/S))/2。

如下图接线,VCC 供 5V电源, GND 为地线,TRIG 触发控制信号输入,接板子的X2,ECHO 回响信号输出,接板子的X1,四个接口端。

三、实验一:超声波模块测距
1、控制5110显示屏显示6x8字符
先看一下LCD5110针脚含义吧(注意:LCD5110的针脚有些不一样的)
TPYBoard的针脚与5110的针脚对应关系如下:
TPYBoard       LCD5110    memo
----------------------------
# any   Pin        => RST       Reset pin (0=reset, 1=normal)
# any   Pin        => CE        Chip Enable (0=listen for input,   1=ignore input)
# any   Pin        => DC        Data/Command (0=commands, 1=data)
#   MOSI          => DIN       data flow (Master out, Slave in)
#   SCK           => CLK       SPI clock
# 3V3   or any Pin  => VCC       3.3V logic voltage (0=off, 1=on)
# any   Pin        => LIGHT     Light (0=on, 1=off)
#   GND           => GND


还是看不明白的话,直接上针脚编号吧
TPYBoard       LCD5110    memo
----------------------------
Y10        => RST       Reset pin (0=reset, 1=normal)
Y11        => CE        Chip Enable (0=listen for input, 1=ignore input)
Y9         => DC        Data/Command (0=commands, 1=data)
X8         => DIN       data flow (Master out, Slave in)
X6         => CLK       SPI clock
VCC
Y12        => LIGHT     Light (0=on, 1=off)
GND


 










  接线ok后,并且导入font.py文件和upcd8544.py文件,编写main.py将测到的距离显示在5110显示屏上,运行main.py就ok了。
  源代码下载地址:http://www.tpyboard.com/support/studyexample14/206.html



    2、程序源代码



    import pyb
    from pyb import Pin
    from pyb import Timer
    import upcd8544
    from machine import SPI,Pin
    Trig = Pin('X2',Pin.OUT_PP)
    Echo = Pin('X1',Pin.IN)
    num=0
    flag=0
    run=1
    def start(t):
    global flag
    global num
    if(flag==0):
    num=0
    else:





    num=num+1
    def stop(t):
    global run
    if(run==0):
    run=1
    start1=Timer(1,freq=10000,callback=start)
    stop1=Timer(4,freq=2,callback=stop)
    while True:
    if(run==1):
    SPI = pyb.SPI(1) #DIN=>X8-MOSI/CLK=>X6-SCK
    #DIN =>SPI(1).MOSI 'X8' data flow (Master out, Slave in)
    #CLK =>SPI(1).SCK  'X6' SPI clock
    RST    = pyb.Pin('Y10')
    CE     = pyb.Pin('Y11')
    DC     = pyb.Pin('Y9')
    LIGHT  = pyb.Pin('Y12')
    lcd_5110 = upcd8544.PCD8544(SPI, RST, CE, DC, LIGHT)
    Trig.value(1)
    pyb.udelay(100)
    Trig.value(0)
    while(Echo.value()==0):
    Trig.value(1)
    pyb.udelay(100)
    Trig.value(0)
    flag=0
    if(Echo.value()==1):
    flag=1
    while(Echo.value()==1):
    flag=1
    if(num!=0):
    #print('num:',num)
    distance=num/10000*34299/2
    print('Distance:')
    print(distance,'cm')
    lcd_5110.lcd_write_string('Distance',0,0)
    lcd_5110.lcd_write_string(str(distance),0,1)
    lcd_5110.lcd_write_string('cm',50,1)
    flag=0
    run=0
    3、实验实拍图
    靠近桌边:
 

离桌边10cm左右:

实验:V102加一个5110屏,加一个超声波,直接显示障碍到V102的距离
    四、电机驱动模块
    1、什么是电机驱动模块
    电机驱动模块主要是可以控制电机的运行:调速、运行、停止、步进、匀速等操作
    2、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的高低电平,来控制电机的转动,从而让小车前进,后退,向左,向右。


 








    五、制作避障小车
    利用底盘+V102+超声波+L298N当小车往前开时,遇到障碍会自己后退躲避。
    1、实验效果
http://player.youku.com/player.php/sid/XMjY0ODA2NzkyMA==/v.swf
    2、程序源代码

    # main.py -- put your code here!
    import pyb
    from pyb import Pin
    from pyb import Timer
    Trig = Pin('X9',Pin.OUT_PP)
    Echo = Pin('X10',Pin.IN)
    num=0
    flag=0
    run=1
    def start(t):
    global flag
    global num
    if(flag==0):
    num=0
    else:
    num=num+1
    def stop(t):
    global run
    if(run==0):
    run=1
    start1=Timer(1,freq=10000,callback=start)
    stop1=Timer(4,freq=2,callback=stop)
    x1 = Pin('X1', Pin.OUT_PP)
    x2 = Pin('X2', Pin.OUT_PP)
    y1 = Pin('Y1', Pin.OUT_PP)
    y2 = Pin('Y2', Pin.OUT_PP)
    def left():
    x1.high()
    x2.low()
    y1.high()
    y2.low()
    def go():
    x1.high()
    x2.low()
    y1.low()
    y2.high()
    def back():
    x1.low()
    x2.high()
    y1.high()
    y2.low()
    def right():
    x1.low()
    x2.high()
    y1.low()
    y2.high()
    def stop():
    x1.low()
    x2.low()
    y1.low()
    y2.low()
    while True:
    if(run==1):
    Trig.value(1)
    pyb.udelay(100)
    Trig.value(0)
    while(Echo.value()==0):
    Trig.value(1)
    pyb.udelay(100)
    Trig.value(0)
    flag=0
    if(Echo.value()==1):
    flag=1
    while(Echo.value()==1):
    flag=1
    if(num!=0):
    #print('num:',num)
    distance=num/10000*34299/2
    print('Distance')
    print(distance,'cm')
    if distance>=20:
    go()
    if distance<=20: stop() back() flag=0 run=0





















关键词: TPYBoard-Micropython     之会     p    

专家
2017-03-25 13:05:15    评分
2楼
楼主厉害哦。

专家
2017-03-25 14:11:19    评分
3楼
向楼主学习。

管理员
2017-03-26 18:41:14    评分
4楼
谢谢楼主分享  涨姿势了

共4条 1/1 1 跳转至

回复

匿名不能发帖!请先 [ 登陆 注册 ]