STM32循迹小车系列教程(四)—— 使用OpenMV循迹

avatar
作者
筋斗云
阅读量:0

 本章节主要讲解如何使用OpenMV循迹以及OpenMV与STM32串口通信

前言

软件:STM32CubeMx、Keil5 MDK、串口调试助手XCOM、OpenMV_IDE

硬件:OpenMV、STM32F103C8T6核心板、下载器ST_LINK、USB转TTL或J-LINK、小车一辆

OpenMV简介

OpenMV是一个开源,功能强大的机器视觉模块。

它以STM32F427CPU为核心,集成了OV7725摄像头芯片,在小巧的硬件模块上,用C语言高效地实现了核心机器视觉算法,提供Python编程接口。它的机器视觉算法包括 寻找色块、人脸检测、眼球跟踪、边缘检测、标志跟踪等等。

循迹方法

 运行起来的效果如图所示

该方法和一般循迹模块的原理差不多。

使用红框对图像进行分割,这些框作为我们用来巡线的依据,当出现在框内的颜色,符合设置的阙值,就相当于检测到了赛道线。

使用OpenMV循迹的方便之处在于各种颜色的线都可以寻,只需要将对应的阙值修改过了就可以了,并且OpenMV还可以同时完成识别数字或者物体的任务,具体资料可查看星瞳科技官网

具体实现

接下来我们将展示如何实现OpenMV循迹。

首先,我们先设置我们摄像头拍摄到画面上的框大小和位置

    for rec in roi1:         img.draw_rectangle(rec, color=(255,0,0))#绘制出roi区域   就画出框

绘制5个检测区域,对应五路循迹

roi1 =     [(0, 40, 20, 40),        # L1 x y w h        每个对应画的框的位置,最后两个是框的大小             (35, 40, 20, 40),       # L2             (70,40,10,10),          # M0             (105,40,20,40),         # R1             (140,40,20,40)]         # R2

设定要识别的颜色阙值,下面是黑线的阙值代码,如果要循其他颜色的线,需要将其修改成对应颜色的阈值即可

GROUND_THRESHOLD=(21, 100, -124, 32, -26, 22)#黑线  设置要寻的线的阈值。在颜色空间中,阈值被用于定义需要跟踪的颜色 

主函数部分

检测到线返回1,否则返回0

    blob1=None     blob2=None     blob3=None     blob4=None     blob5=None     flag = [0,0,0,0,0]     img = sensor.snapshot().lens_corr(strength = 1.7 , zoom = 1.0)#畸变矫正  获取图像帧       blob1 = img.find_blobs([GROUND_THRESHOLD1], roi=roi1[0]) #left     blob2 = img.find_blobs([GROUND_THRESHOLD1], roi=roi1[1]) #middle     blob3 = img.find_blobs([GROUND_THRESHOLD1], roi=roi1[2])     blob4 = img.find_blobs([GROUND_THRESHOLD1], roi=roi1[3])     blob5 = img.find_blobs([GROUND_THRESHOLD1], roi=roi1[4])      if blob1:         flag[0] = 1  #左边检测到黑线     if blob2:         flag[1] = 1  #中间检测到黑线     if blob3:         flag[2] = 1  #右边检测到黑线     if blob4:         flag[3] = 1  #中间检测到黑线     if blob5:         flag[4] = 1  #右边检测到黑线

串口通信部分

控制小车循迹使用OpenMV往往是不够的,我们一般使用OpenMV对赛道图像进行处理,将处理过后的数据使用串口发送给STM32,使用STM32控制小车行驶。

它的目的是为了将OpenMV观测到的数据告诉STM32,让小车做出相对的反应。

代码如下:

初始化串口3,波特率115200,8 bit,无奇偶校验,1停止位,溢出时间1000ms

uart = UART(3,115200,bits=8, parity=None, stop=1, timeout_char = 1000)   #初始化串口 

处理数据,将数组2进制数转换为16进制数打包发送

data=0 for i in (0,1,2,3,4): # 0 1 2 3 4      把从最左边到最右边,检测到的记1,然后转化成16进制         data|=(flag[i]<<(4-i))

以一定协议的格式发送

def sending_data(data):  #A5 A6 data     global uart;     data = ustruct.pack("<bbb",      #格式为俩个字符俩个短整型(2字节)                    0xA5,                      #帧头1                    0xA6,                    data                    )        #数组大小为7,其中2,3,4,5为有效数据,0,1,6为帧头帧尾     uart.write(data);   #必须要传入一个字节数组

STM32串口解析

使用中断回调函数对数据进行解析,串口具体配置详见往期教程STM32CubeMx使用教程(三)——串口通信、串口协议

void HAL_UART_RxCpltCallback(UART_HandleTypeDef *huart) {   UNUSED(huart); 	 	if(huart->Instance == USART1) 	{ 		rec_dat[rec_pointer++] = rec_buf; 		 		if(rec_pointer == 3)//接收完成 		{ 			rec_pointer = 0; 			if(rec_dat[0] == 0xA5 && rec_dat[1] == 0xA6)//判断帧头 				sensor_val = rec_dat[2]; 			else 				memset(rec_dat,'\0',sizeof(rec_dat)); 		} 		HAL_UART_Receive_IT(&huart1,(uint8_t *)&rec_buf,1); 	} }

将STM32与OpenMV连接

OpenMV_RX P5接STM32_TX1 PA9
OpenMV_TX P4接STM32_RX1 PA10
OpenMV_GND接STM32_GND

进入Debug可以观察到sensor_val的变化,根据sensor_val的变化驱动左右轮转速沿着赛道线循迹,具体循迹部分可参考往期教程。

需要代码的朋友可以点击以下链接下载,有问题请私信我。 

x(85条消息) 【免费】STM32循迹小车(灰度+OpenMV权重判断)资源-CSDN文库 

广告一刻

为您即时展示最新活动产品广告消息,让您随时掌握产品活动新动态!