美文网首页玩转树莓派树莓派树莓派
树莓派综合项目3：AI视觉机械臂小车（四）红外避障

树莓派综合项目3：AI视觉机械臂小车（四）红外避障

作者: Maker张 | 来源:发表于2021-05-20 17:32 被阅读0次

    一、介绍

      树莓派综合项目3：AI视觉机械臂小车（一）蜂鸣器
      树莓派综合项目3：AI视觉机械臂小车（二）轻触按键
      树莓派综合项目3：AI视觉机械臂小车（三）基本运动
      本实验将实现履带车的红外避障功能，这个也比较简单，在以前的文章中有更基础细致的讲解可以参考：
      树莓派基础实验28：红外避障传感器实验
      树莓派综合项目2：智能小车（五）红外避障

      本实验中不同的是采用了E18-D80NK漫反射式红外光电开关避障传感器模块。同时除了使用RPi.GPIO库编程以外，再使用gpiozero库来实现。

    红外传感器避障

    二、组件

    三、实验原理

    E18-D80NK红外光电模块

    E18-D80NK是一种及发射与接收于一体的光电传感器，发射光经过调制后发出，接收头对反射光进行解调输出，有效的避免了可见光的干扰。透镜的使用，也使得这款传感器最远可以检测80厘米距离的物体（由于红外光的特性，不同颜色的物体，能探测到的最大距离也不同，白色物体最远，黑色物体最近）。

    检测障碍物的距离可以根据要求，通过尾部的电位器旋钮进行调节。


    E18-D80NK的参数

    这个NPN型光电开关的输出组是0或1，即数字电路中的高电平与低电平。检测到目标是低电平输出，正常状态是高电平输出。光电开关就三条线：电源、地、输出，输出不需要进行AD转换。

    四、实验步骤

      第1步： 在上面的扩展板TB6612FNG芯片电路图上可以知道连接GPIO的接线情况，A通道为左轮控制，B通道为右轮控制：

    PWMA AIN1 AIN2 PWMB BIN1 BIN2
    GPIO18 GPIO22 GPIO27 GPIO23 GPIO25 GPIO24
    左侧红外模块输出 右侧红外模块输出
    GPIO12 GPIO16

      第2步： 编写程序。这里先使用RPi.GPIO库来编写程序，当按下按键后车辆开始行进，左右都没探测到障碍物时直行，左侧探测到障碍物时右转，右侧探测到障碍物时左转，否则就是左右都探测到障碍物停止0.3秒，再后退0.4秒，再左转0.5秒。

    #!/usr/bin/python  
# coding=utf-8  
#本段代码实现树莓派智能小车的红外避障效果
#代码使用的树莓派GPIO是用的BCM编码方式。

import RPi.GPIO as GPIO  
import time  
import sys 
 
SensorRight = 16
SensorLeft  = 12

PWMA   = 18
AIN1   = 22
AIN2   = 27

PWMB   = 23
BIN1   = 25
BIN2   = 24

BtnPin  = 19
Gpin    = 6
Rpin    = 5

#智能小车运动函数 
def t_up(speed,t_time):
        L_Motor.ChangeDutyCycle(speed)
        GPIO.output(AIN2,False)#AIN2
        GPIO.output(AIN1,True) #AIN1

        R_Motor.ChangeDutyCycle(speed)
        GPIO.output(BIN2,False)#BIN2
        GPIO.output(BIN1,True) #BIN1
        time.sleep(t_time)
        
def t_stop(t_time):
        L_Motor.ChangeDutyCycle(0)
        GPIO.output(AIN2,False)#AIN2
        GPIO.output(AIN1,False) #AIN1

        R_Motor.ChangeDutyCycle(0)
        GPIO.output(BIN2,False)#BIN2
        GPIO.output(BIN1,False) #BIN1
        time.sleep(t_time)
        
def t_down(speed,t_time):
        L_Motor.ChangeDutyCycle(speed)
        GPIO.output(AIN2,True)#AIN2
        GPIO.output(AIN1,False) #AIN1

        R_Motor.ChangeDutyCycle(speed)
        GPIO.output(BIN2,True)#BIN2
        GPIO.output(BIN1,False) #BIN1
        time.sleep(t_time)

def t_left(speed,t_time):
        L_Motor.ChangeDutyCycle(speed)
        GPIO.output(AIN2,True)#AIN2
        GPIO.output(AIN1,False) #AIN1

        R_Motor.ChangeDutyCycle(speed)
        GPIO.output(BIN2,False)#BIN2
        GPIO.output(BIN1,True) #BIN1
        time.sleep(t_time)

def t_right(speed,t_time):
        L_Motor.ChangeDutyCycle(speed)
        GPIO.output(AIN2,False)#AIN2
        GPIO.output(AIN1,True) #AIN1

        R_Motor.ChangeDutyCycle(speed)
        GPIO.output(BIN2,True)#BIN2
        GPIO.output(BIN1,False) #BIN1
        time.sleep(t_time)
        
def keysacn():
    # 按下按键后，车辆才行进
    val = GPIO.input(BtnPin)
    while GPIO.input(BtnPin) == False:
        val = GPIO.input(BtnPin)
    while GPIO.input(BtnPin) == True:
        time.sleep(0.01)
        val = GPIO.input(BtnPin)
        if val == True:
            GPIO.output(Rpin,1)
            while GPIO.input(BtnPin) == False:
                GPIO.output(Rpin,0)
        else:
            GPIO.output(Rpin,0)
            
def setup():
    GPIO.setwarnings(False)
    GPIO.setmode(GPIO.BCM)       # 按物理位置给GPIOs编号
    GPIO.setup(Gpin, GPIO.OUT)     # 设置绿色Led引脚模式输出
    GPIO.setup(Rpin, GPIO.OUT)     # 设置红色Led引脚模式输出
    GPIO.setup(BtnPin, GPIO.IN, pull_up_down=GPIO.PUD_UP)    # 设置输入BtnPin模式，拉高至高电平(3.3V) 
    GPIO.setup(SensorRight,GPIO.IN)
    GPIO.setup(SensorLeft,GPIO.IN)
    
    GPIO.setup(AIN2,GPIO.OUT)
    GPIO.setup(AIN1,GPIO.OUT)
    GPIO.setup(PWMA,GPIO.OUT)

    GPIO.setup(BIN1,GPIO.OUT)
    GPIO.setup(BIN2,GPIO.OUT)
    GPIO.setup(PWMB,GPIO.OUT)
    
if __name__ == '__main__':
    setup()
    keysacn()
    L_Motor= GPIO.PWM(PWMA,100)
    L_Motor.start(0)
    R_Motor = GPIO.PWM(PWMB,100)
    R_Motor.start(0)
    try:
        while True:
            SR_2 = GPIO.input(SensorRight)
            SL_2 = GPIO.input(SensorLeft)
            if SL_2 == True and SR_2 == True: # 高电平表示无障碍
                print("t_up")
                t_up(50,0)
            elif SL_2 == True and SR_2 ==False:
                print("Left")
                t_left(50,0)
            elif SL_2==False and SR_2 ==True:
                print("Right")
                t_right(50,0)
            else:
                t_stop(0.3)
                t_down(50,0.4)
                t_left(50,0.5)
    except KeyboardInterrupt:  # 当按下Ctrl+C时，将执行子程序destroy()。
        GPIO.cleanup()

      第3步：使用GPIO Zero库来重新编写程序，引入了Button，Motor，LED，LineSensor几个基本类，使得程序变得简洁易懂，降低了编程难度，特别是等待按键按下的keysacn()函数简化为了两句。

    #!/usr/bin/python  
# coding=utf-8  
#本段代码实现树莓派智能小车的红外避障效果
#代码使用的树莓派GPIO是用的BCM编码方式。
from gpiozero import Button,Motor,LED,LineSensor  # LineSensor为红外线路传感器
import time  
 
SensorRight = 16
SensorLeft  = 12
sR = LineSensor(SensorRight)
sL = LineSensor(SensorLeft)

PWMA   = 18
AIN1   = 22
AIN2   = 27
PWMB   = 23
BIN1   = 25
BIN2   = 24
L_Motor = Motor(forward=AIN1, backward=AIN2,enable=PWMA,pwm=True)
R_Motor = Motor(forward=BIN1, backward=BIN2,enable=PWMB,pwm=True)

BtnPin  = 19
button = Button(BtnPin,pull_up = False) # 默认情况下True，GPIO引脚将被拉高,这里接线反了，要为False

Gpin    = 6
Rpin    = 5
Gled = LED(Gpin)
Rled = LED(Rpin)

#智能小车运动函数 
def t_up(speed,t_time):
        L_Motor.forward(speed)
        R_Motor.forward(speed)
        time.sleep(t_time)
        
def t_stop(t_time):
        L_Motor.stop()
        R_Motor.stop()
        time.sleep(t_time)
        
def t_down(speed,t_time):
        L_Motor.backward(speed)
        R_Motor.backward(speed)
        time.sleep(t_time)

def t_left(speed,t_time):
        L_Motor.backward(speed)
        R_Motor.forward(speed)
        time.sleep(t_time)

def t_right(speed,t_time):
        L_Motor.forward(speed)
        R_Motor.backward(speed)
        time.sleep(t_time)  
        
def keysacn():
    button.wait_for_press() # 等待按钮按下后才继续执行程序
    Rled.on()
    
if __name__ == '__main__':
    keysacn()
    try:
        while True:
            if sL.value == 1 and sR.value == 1:
                print("t_up")
                t_up(0.5,0)
            elif sL.value == 1 and sR.value == 0:
                print("Left")
                t_left(0.5,0)
            elif sL.value == 0 and sR.value == 1:
                print("Right")
                t_right(0.5,0)
            else:
                print("Back")
                t_stop(0.3)
                t_down(0.5,0.4)
                t_left(0.5,0.5)
    except KeyboardInterrupt:  # 当按下Ctrl+C时，将执行子程序destroy()。
        print("Ending Program")

    相关文章

      网友评论

        本文标题：树莓派综合项目3：AI视觉机械臂小车（四）红外避障

        本文链接：https://www.haomeiwen.com/subject/oavpjltx.html

        延伸阅读

        深度阅读

        • 您也可以注册成为美文阅读网的作者，发表您的原创作品、分享您的心情！

        栏目导航

        热点阅读

        玩转树莓派

        树莓派

        树莓派

        关于我们|服务条款|联系我们|树莓派综合项目3：AI视觉机械臂小车（四）红外避障|投稿指南|网站地图|RSS订阅|排版工具|手机版

        提供经典美文摘抄,优美散文欣赏,现代诗歌精选,短篇小说,心情随笔,表白情书范文,故事会在线阅读欣赏

        Copyright © 2014-2023 Haomeiwen.com All Rights Reserved. 好美文阅读网 版权所有

        备案信息：桂公网安备 45052102000051号 · 桂ICP备13007215号-3

        本站所收录作品、热点评论等信息部分来源互联网，目的只是为了系统归纳学习和传递资讯

        所有作品版权归原创作者所有，与本站立场无关，如不慎侵犯了你的权益，请联系我们告知，我们将做删除处理！