文章目录
- 0 前言
- 1 简介
- 2 主要机器
- 3 树莓派简介
- 4 基本运动-TB6612FNG驱动芯片
- 5 红外避障功能
- 6 最后
0 前言
🔥 这两年开始毕业设计和毕业答辩的要求和难度不断提升,传统的毕设题目缺少创新和亮点,往往达不到毕业答辩的要求,这两年不断有学弟学妹告诉学长自己做的项目系统达不到老师的要求。
为了大家能够顺利以及最少的精力通过毕设,学长分享优质毕业设计项目,今天要分享的是
🚩 毕业设计 基于树莓派的AI视觉机械臂小车
🥇学长这里给一个题目综合评分(每项满分5分)
- 难度系数:3分
- 工作量:3分
- 创新点:5分
🧿 选题指导, 项目分享:
https://gitee.com/dancheng-senior/project-sharing-1/blob/master/%E6%AF%95%E8%AE%BE%E6%8C%87%E5%AF%BC/README.md
1 简介
基于树莓派的AI视觉和机械臂。视觉识别是一个主要内容,是信息输入的重要方式,而机械臂是机器人输出、工作的重要方式,比如农业采摘机器人。因此,AI视觉和机器的互相配合加持对实际生产生活具有很大的意义。
2 主要机器
- 机器人套件
- 蜂鸣器
- 轻触按键
- 漫反射红外光电避障传感模块
3 树莓派简介
智能小车的大脑是一块信用卡大小的树莓派板子,所以DIY冲动的朋友可以到各大商城购买一块最新版的树莓派,:
树莓派第三代张这个样子——正面照
简单介绍:
- Micro-USB Power–电源插槽
- CPU
- 四个USB接口
- 一个HDMI接口
- 一个耳机插孔,也可以输出视频
- 40个GPIO引脚
- 一个SD卡插槽,没有硬盘
- 一个网线插口,自带无线网卡
- 树莓派相机插槽
- Micro-USB Power,树莓派供电接口
所有具体接口如何使用,详细讲解的话会使该篇文章显得拖沓,放在其它篇幅讲解,目前不懂没关系,不影响到我们制作智能小车。
1.电源适配器 5V 2A
2.移动电源 输出5V 2.1A
注意:Pi没有板载稳压芯片,只能且必须用5V的电源给Pi供电。如果电压过大,Pi会永久“变砖”,等着流泪吧!
4 基本运动-TB6612FNG驱动芯片
采用了TB6612FNG驱动芯片,电机电源接口带有反接保护电路,相对于传统的L298N在效率上提高很多,体积上也大幅减小,使用方法和L298N类似。
同时除了使用RPi.GPIO库编程以外,再使用gpiozero库的Motor类来实现电机控制。
实验原理
TB6612FNG是东芝半导体公司生产的一款直流电机驱动器件,具有大电流MOSFET-H桥结构,双通道电路输出,也就是可以驱动两个电机。
扩展板上使用了两块TB6612FNG芯片,但是并联的,只有两路输出,可以用作备份,也可以用作2路4驱。
下面分别是控制两个电机的IO口:
STBY口接单片机的IO口清零电机全部停止,置1通过AIN1 AIN2,BIN1,BIN2 来控制正反转
VM 接15V以内电源
VCC 接2.7v – 5V电源
GND 接地
驱动1路:
PWMA 接单片机的PWM口
A01、AO2 接电机1的两个脚
驱动2路:
PWMB 接单片机的PWM口
B01、BO2 接电机2的两个脚
注意: 若是pwm控制,则需要pwm频率100khz ,亲测80khz也好用,同时STBY引脚需要接高电平。
程序编写
#!/usr/bin/env python2
# -*- coding: utf-8 -*-
import RPi.GPIO as GPIO
import time
PWMA = 18
AIN1 = 22
AIN2 = 27
PWMB = 23
BIN1 = 25
BIN2 = 24
GPIO.setwarnings(False)
GPIO.setmode(GPIO.BCM)
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)
L_Motor= GPIO.PWM(PWMA,80000)
L_Motor.start(0)
R_Motor = GPIO.PWM(PWMB,80000)
R_Motor.start(0)
def t_up(speed,t_time):
L_Motor.ChangeDutyCycle(speed)
GPIO.output(AIN2,False)
GPIO.output(AIN1,True) # AIN1高电平为前进
R_Motor.ChangeDutyCycle(speed)
GPIO.output(BIN2,False)
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)
R_Motor.ChangeDutyCycle(speed)
GPIO.output(BIN2,True) # BIN2高电平为后退
GPIO.output(BIN1,False)
time.sleep(t_time)
def t_left(speed,t_time):
L_Motor.ChangeDutyCycle(speed)
GPIO.output(AIN2,True) # 左轮后退
GPIO.output(AIN1,False)
R_Motor.ChangeDutyCycle(speed)
GPIO.output(BIN2,False)
GPIO.output(BIN1,True) # 右轮前进
time.sleep(t_time)
def t_right(speed,t_time):
L_Motor.ChangeDutyCycle(speed)
GPIO.output(AIN2,False)
GPIO.output(AIN1,True) # 左轮前进
R_Motor.ChangeDutyCycle(speed)
GPIO.output(BIN2,True) # 右轮后退
GPIO.output(BIN1,False)
time.sleep(t_time)
try:
while True:
t_up(50,3)
t_down(50,3)
t_left(50,3)
t_right(50,3)
t_stop(3)
except KeyboardInterrupt:
GPIO.cleanup()
5 红外避障功能
采用了E18-D80NK漫反射式红外光电开关避障传感器模块。同时除了使用RPi.GPIO库编程以外,再使用gpiozero库来实现。
实验原理
E18-D80NK是一种及发射与接收于一体的光电传感器,发射光经过调制后发出,接收头对反射光进行解调输出,有效的避免了可见光的干扰。透镜的使用,也使得这款传感器最远可以检测80厘米距离的物体(由于红外光的特性,不同颜色的物体,能探测到的最大距离也不同,白色物体最远,黑色物体最近)。
检测障碍物的距离可以根据要求,通过尾部的电位器旋钮进行调节。
传感器相关参数
这个NPN型光电开关的输出组是0或1,即数字电路中的高电平与低电平。检测到目标是低电平输出,正常状态是高电平输出。光电开关就三条线:电源、地、输出,输出不需要进行AD转换。
在上面的扩展板TB6612FNG芯片电路图上可以知道连接GPIO的接线情况,A通道为左轮控制,B通道为右轮控制:
程序编写
这里先使用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()