前往小程序,Get更优阅读体验!
立即前往
首页
学习
活动
专区
工具
TVP
发布
社区首页 >专栏 >树莓派综合项目3:AI视觉机械臂小车(四)红外避障

树莓派综合项目3:AI视觉机械臂小车(四)红外避障

作者头像
张国平
修改2021-06-02 10:58:34
1.4K0
修改2021-06-02 10:58:34
举报
文章被收录于专栏:张国平_玩转树莓派

一、介绍

树莓派综合项目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秒。

代码语言:txt
复制
#!/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()函数简化为了两句。

代码语言:txt
复制
#!/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")
本文参与 腾讯云自媒体同步曝光计划,分享自作者个人站点/博客。
如有侵权请联系 cloudcommunity@tencent.com 删除

本文分享自 作者个人站点/博客 前往查看

如有侵权,请联系 cloudcommunity@tencent.com 删除。

本文参与 腾讯云自媒体同步曝光计划  ,欢迎热爱写作的你一起参与!

评论
登录后参与评论
0 条评论
热度
最新
推荐阅读
目录
  • 一、介绍
  • 二、组件
  • 三、实验原理
  • 四、实验步骤
领券
问题归档专栏文章快讯文章归档关键词归档开发者手册归档开发者手册 Section 归档