齐护K210系列教程(三十四)_视觉PID巡线小车

2024-05-25 10:52

本文主要是介绍齐护K210系列教程(三十四)_视觉PID巡线小车,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

视觉PID巡线小车

  • 1.前言
  • 2.简介
  • 3.代码讲解
    • 3.1初始化
    • 3.2.色块查找
    • 3.3色块分析
      • 3.3.1 区域1
      • 3.3.2 区域2
    • 3.4 侦测关键点部分
      • 3.4.1正常巡线
      • 3.4.2 右转路口
    • 3.4.3十字路口
    • 3.4. PID计算
  • 4.完整代码
  • 5.小车端程序
  • 6.参考程序
  • 联系我们

1.前言

本课程主要讲述如何使用AIstart_k210主板完成简单的PID寻线任务,并举例应用齐护小车的PID寻线图形化编程。

也可以采用 AIstart_Q1+扩展板(自带电机驱动等功能)的方式直接一个 K210主板就完成算法及电机运行,可以参考教程:【齐护人工智能小车学习套件】

原理:通过调用K210模块中现有的查找色块方法,获取偏移量和关键点(如十字路口,T字路口,起停线等)的位置数据,并将数据返回给小车进行巡线。

固件使用: firmware_2055KB.bin(齐护标准固件即可)

2.简介

通过在指定区域寻找黑色块相对于屏幕的偏移量,并对偏移量进行PID运算后,将结果通过串口发送给小车执行。
在这里插入图片描述

如上图所示,在区域1(红色框内)内检测黑色块的中心点位置相对于屏幕中心的偏移量。

在区域2(红色框内)检测黑色块,用于判断是路口状态。

3.代码讲解

3.1初始化

在这里插入图片描述

用于PID运算的变量初始化,其中Kp,Kd为比例和微分系数。

串口初始化,用于K210向小车传送信息。

LCD初始化

摄像头初始化,为了颜色更好识别,摄像头为黑白模式。

将像素模式设置为灰度灰度模式对于只有两种颜色的地图可以起到提高帧数,过滤其它颜色的影响,提高了识别的正确率。

3.2.色块查找

在这里插入图片描述

从摄像头获取图像
对图像进行色块查找,参数意义如下:
图像:要查找的图片对象。
阀值:用LAB表示的颜色阀值,因为图像是灰度的,所以其范围为0~255(黑到白)
区域:要检测的区域。
滤掉区域:面积阈值,如果色块被框起来的面积小于这个值,会被过滤掉,减少干扰提高巡线准确度
滤掉素数:像素个数阈值,如果色块像素数量小于这个值,会被过滤掉,同上面作用相同。
合并:为边界,如果设置为1,那么两个blobs如果间距1一个像素点,也会被合并。此参数只在检测关键点寻找色块函数中运用,可以更明确的侦测出关键点,如Y型路口。
重叠:为真时,将所有重叠的blob合并为一个。

3.3色块分析

3.3.1 区域1

在这里插入图片描述

判断是否检测到黑色色块。
对检测结果就行迭代。
结果内会返回色块的信息,如坐标,中心点等数据,使用这些数据可以在图像上标注出其位置。
将色块的中心点传送到PID计算函数就行位置计算,并得到偏移量。
将偏移发送给小车执行.

3.3.2 区域2

在这里插入图片描述

判断是否检测到黑色色块。
对检测结果就行迭代。
结果内会返回色块的信息,如坐标,中心点等数据,使用这些数据可以在图像上标注出其位置。
通过其宽度参数给于不同的判断,并将结果发送给小画执行。
将图像显示在屏幕上。

3.4 侦测关键点部分

​ 当要经过十字路口,y型路口,起停线时,可以通过判断对像的宽度值来区分。(区域2内进行分析)
在这里插入图片描述

3.4.1正常巡线

正常巡线宽度会比较小
在这里插入图片描述

3.4.2 右转路口

可以将长方体的中心坐标输出,当在屏幕左边时代表是左T型路口,在右边时侧是右T型路口。
在这里插入图片描述

3.4.3十字路口

在这里插入图片描述

​ 只需要判断色块的宽度和中心坐标就可以区别出不同的路况。

3.4. PID计算

在这里插入图片描述

  1. 声明全局变量,在函数中使用全局变量需要声明,否则会被视为局部变量。
  2. 传入的x坐标为屏中心点为0点。
  3. P项为偏差乘系数
  4. D项为与上次的偏差的差乘以系数
  5. 输出数据
    ​ 其中的 Kp 和 Kd 是巡线PID的参数没有使用到积分参数,Kd设置为0的原因是因为仅仅调节Kp时巡线就已经很稳定了,如果你的小车仅靠Kp无法达到稳定或者出现了高频振荡,请自行调节Kd。

4.完整代码

在这里插入图片描述

上传程序后测试,可以看到对应的输出数据。

在这里插入图片描述

5.小车端程序

以齐护编程小车为例,核心为ArduinoUNO 328P主控。

小车端程序主要是对串口数据进行处理,在K210端我们的18-19为串口数据输出端,对接我们小车上的A2-A3,波特率为9600要相同,TX-RX交叉连接。
在这里插入图片描述

  1. 主串口的初始化
  2. 接收信息软件串口的初始化,波特率要与K210相同。
  3. 使用的中间变量的初始化
  4. 当串口收到数据时,开始接收数据。
  5. K210发出的每条数据都带了回车,读取这一段数据。
  6. 判断收到的数据是不是偏差数据
  7. 截取有效数据并转化为整数。保存在变量内用于控制小车的速度。
  8. 如果C开头则是路口类型,K210根据实际判断结果发送对应标志,在这里进行解析。也可以将宽度发送过来,在这里进行处理。
  9. 根据偏移量计算出电机的转速。
    当偏差小于零时说明小车向右偏,需要增加左轮的速度,减小右轮的速度,反之亦然。

6.参考程序

齐护编程AIstart_k210巡线scratch

联系我们

扫码或者点这里加群了解更多!
在这里插入图片描述
Created by qdprobot

这篇关于齐护K210系列教程(三十四)_视觉PID巡线小车的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/1001297

相关文章

如何为Yarn配置国内源的详细教程

《如何为Yarn配置国内源的详细教程》在使用Yarn进行项目开发时,由于网络原因,直接使用官方源可能会导致下载速度慢或连接失败,配置国内源可以显著提高包的下载速度和稳定性,本文将详细介绍如何为Yarn... 目录一、查询当前使用的镜像源二、设置国内源1. 设置为淘宝镜像源2. 设置为其他国内源三、还原为官方

Maven的使用和配置国内源的保姆级教程

《Maven的使用和配置国内源的保姆级教程》Maven是⼀个项目管理工具,基于POM(ProjectObjectModel,项目对象模型)的概念,Maven可以通过一小段描述信息来管理项目的构建,报告... 目录1. 什么是Maven?2.创建⼀个Maven项目3.Maven 核心功能4.使用Maven H

IDEA自动生成注释模板的配置教程

《IDEA自动生成注释模板的配置教程》本文介绍了如何在IntelliJIDEA中配置类和方法的注释模板,包括自动生成项目名称、包名、日期和时间等内容,以及如何定制参数和返回值的注释格式,需要的朋友可以... 目录项目场景配置方法类注释模板定义类开头的注释步骤类注释效果方法注释模板定义方法开头的注释步骤方法注

Python虚拟环境终极(含PyCharm的使用教程)

《Python虚拟环境终极(含PyCharm的使用教程)》:本文主要介绍Python虚拟环境终极(含PyCharm的使用教程),具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,... 目录一、为什么需要虚拟环境?二、虚拟环境创建方式对比三、命令行创建虚拟环境(venv)3.1 基础命令3

使用Node.js制作图片上传服务的详细教程

《使用Node.js制作图片上传服务的详细教程》在现代Web应用开发中,图片上传是一项常见且重要的功能,借助Node.js强大的生态系统,我们可以轻松搭建高效的图片上传服务,本文将深入探讨如何使用No... 目录准备工作搭建 Express 服务器配置 multer 进行图片上传处理图片上传请求完整代码示例

python连接本地SQL server详细图文教程

《python连接本地SQLserver详细图文教程》在数据分析领域,经常需要从数据库中获取数据进行分析和处理,下面:本文主要介绍python连接本地SQLserver的相关资料,文中通过代码... 目录一.设置本地账号1.新建用户2.开启双重验证3,开启TCP/IP本地服务二js.python连接实例1.

Python 安装和配置flask, flask_cors的图文教程

《Python安装和配置flask,flask_cors的图文教程》:本文主要介绍Python安装和配置flask,flask_cors的图文教程,本文通过图文并茂的形式给大家介绍的非常详细,... 目录一.python安装:二,配置环境变量,三:检查Python安装和环境变量,四:安装flask和flas

Spring Security基于数据库的ABAC属性权限模型实战开发教程

《SpringSecurity基于数据库的ABAC属性权限模型实战开发教程》:本文主要介绍SpringSecurity基于数据库的ABAC属性权限模型实战开发教程,本文给大家介绍的非常详细,对大... 目录1. 前言2. 权限决策依据RBACABAC综合对比3. 数据库表结构说明4. 实战开始5. MyBA

Ubuntu中远程连接Mysql数据库的详细图文教程

《Ubuntu中远程连接Mysql数据库的详细图文教程》Ubuntu是一个以桌面应用为主的Linux发行版操作系统,这篇文章主要为大家详细介绍了Ubuntu中远程连接Mysql数据库的详细图文教程,有... 目录1、版本2、检查有没有mysql2.1 查询是否安装了Mysql包2.2 查看Mysql版本2.

Elasticsearch 在 Java 中的使用教程

《Elasticsearch在Java中的使用教程》Elasticsearch是一个分布式搜索和分析引擎,基于ApacheLucene构建,能够实现实时数据的存储、搜索、和分析,它广泛应用于全文... 目录1. Elasticsearch 简介2. 环境准备2.1 安装 Elasticsearch2.2 J