基于STM32与DFS算法的电脑鼠的研究与设计-电子产品世界手机版

基于STM32与DFS算法的电脑鼠的研究与设计

嵌入式系统作者：祝朝坤，韩彦净，谷会斌（郑州工商学院，郑州451400）时间：2022-06-16来源：电子产品世界

摘要：随着人工智能与工业自动化的发展，机器人在各个领域的运用愈发广泛，自动化机器人逐渐代替人力已经成为社会的发展趋势。电脑鼠作为移动机器人的典型代表，涉及到运动控制、传感器、路径规划、机械设计等多个技术领域。本设计对当前市面上流行的电脑鼠机器人进行改进和优化，通过改进电脑鼠的整体结构，提高运行的稳定性，通过设计电脑鼠的运动驱动方案、测距方案，并深入研究电脑鼠的运动算法，并采用DFS 算法重新设计电脑鼠的路径规划算法，实现电脑鼠的最优路径规划。并能够通过上位机实时显示电脑鼠的电池电压、运行模式、实时位置、方向等信息，并可对电脑鼠的参数进行实时修改，以应对不同环境下参数配置的需要，在一定程度上推进了电脑鼠的在现实中的应用。

关键词：DFS；电脑鼠；PID；红外传感器；人工智能；上位机；蓝牙

1 研究背景及意义

近年来，自动化机器人在智慧工业、智慧工地、智能家居等多个领域均得到了广泛的应用，而针对机器人的自动规划路径的研究，也变得更有必要。本设计以 STM32F103RCT6 单片机为主控制器，红外传感器为主要传感器，结合深度优先搜索算法 (depth-first-search, DFS) 算法，对电脑鼠机器人在其当前所处环境（迷宫）中，探索最优运行路径展开研究。

本设计的研究主要从以下几个方面进行。

（1）路径规划：一个好的算法可以使电脑鼠在迷宫中走最少的路线而找出迷宫的终点，所以，研究迷宫算法的过程中，需要对电脑鼠的路径进行规划，而在现实生活中，比如工业机器人在不同的工作站运送物料，就需要对路径进行规划，减少运动的轨迹，可以有效地延长机器人的使用寿命。

（2）智能避障：电脑鼠采用的红外传感器，通过发射红外由墙壁反射再有红外接收管接收，再由主控制器进行 ADC 采集，计算出墙壁的距离。

（3）运动控制：电脑鼠在迷宫中运行时，需要时刻保持电脑鼠位置处于赛道的中间位置，这就需要对电机的转速进行更加精确的控制。而在电脑鼠进行转弯的过程中对转速的要求则更加严格。

（4）运动轨迹可视化：电脑鼠在运行过程中，通过蓝牙调试板与 PC 上位机进行通信，电脑鼠实时上报当前的状态，包括电池电压、运动轨迹、当前位置等信息。通过对运行轨迹的分析，可以优化出更好的算法，并且可以通过上位机对电脑鼠内部参数进行修改。

2 系统电路设计

2.1 红外发射电路

SFH4550 工作时的电流为 100 mA，所以串联 50 Ω 电阻进行限流，通过 NMOS 进行驱动，该型号的 MOS 最大电流可达到 5 A，栅源极阈值电压为 2.7 V，因此可以通过微控制器直接进行控制。该电路具有结构简单、高效、利于控制等优点，红外发射电路原理图如图 1。

2.2 红外接收电路

TPS601A 在工作时，接收到对应波长的红外光束，形成到导通回路形成电流，通过电阻进行分压，并通过微控制器进行 AD 转换将电压的模拟量转换为数字量，根据电压的高低，来获取当前电脑鼠与墙壁的距离。红外接收电路原理图如图 2。

2.3 电机驱动电路

电机驱动电路采用的是 TB6612，该电机驱动芯片外围电路设计简单，仅需要两个电容即可。内部具有大电流的 MOSFET-H 桥结构，并且是双通道驱动，一个芯片可以驱动两个电机，支持正转、反转、制动、停止 4 种控制模式，同时内部具有低压保护电路与过热停机保护电路。电机驱动电路原理图如图 3。

2.4 电池电压采集电路

电脑鼠在运行过程中，为防止电池电压过低造成电池的过放电损坏电池，经过查询资料得知 8.4 V 的锂电池组当电压小于 7.4 V 时就属于亏电，所以采用了低电压待机的方案，当电压小于 7.4 V 时启动电脑鼠进入待机状态。分压电阻将电池电压调整到微控制器可以采集的范围。原理图如图 4：

3 微控制器程序设计

3.1 运动控制程序设计

在电脑鼠运行过程中，电脑鼠不断读取红外传感器的数据，通过比例算法实时调整左右电机的转速，实现电脑鼠的位置始终保持在赛道的中间位置。

（2）直角转弯：连续转弯的控制比较复杂，需要对电脑鼠的左右轮行驶的距离和速度进行精确的控制，连续转弯时的运行轨迹如下图 5，经过简单计算可以得出内外圈的长度比为 1:3.5，因此就需要内圈与外圈的转速比需要达到 1:3.5 才能在相同时的时间下经过 90 度转弯。

（3）原地掉头：只需要控制电脑鼠左右轮向互斥方向转动 180 度即可。

3.2 系统程序设计

本程序的系统流程图如图 6，电脑鼠在上电的时候先对红外传感器，电机驱动等外设模块进行初始化，判断电池电压是否正常，如果电池电压过低进入待机状态不启动电脑鼠，如果电池电压正常即进入模式判断，探索模式、固定路线、调试模式三种模式。

（1）探索模式：电脑鼠在探索模式下，不断获取红外传感器信息，在没有发现路口的情况下保持直行的状态，当发现路口时首先会获取当前电脑鼠在迷宫中的坐标信息，在进行与目标点的绝对位置计算，当前进一格后到终点的绝对位置小于转弯后前进一格到终点的绝对位置，那么程序判断直行到达终点的代价会小于转弯到终点的代价，执行继续前进的指令。反之当前进一格后到终点的绝对位置大于转弯后前进一格到终点的绝对位置，那么程序判断直行到达终点的代价会大于转弯到终点的代价，执行转弯指令。直到到达终点，停止运动，进行 DFS 迷宫最短路径解算，如图 7。

（2）固定路线模式：在电脑鼠的比赛中是允许电脑鼠进行多次测试的，当在探索下当电脑鼠到达了终点，并且经过了 DFS 算法解算出最短路径，此时的最短路径信息会被保存在微控制器内部的 Flash，做到掉电不丢失，中途更换电池也不会影响电脑鼠中储存的最短路径信息，程序流程如图 8。

（3）调试模式：该模式主要用于电脑鼠的调试阶段的程序参数的修改，在调试模式下电脑鼠是处在一个待机的状态下的，不断接收上位机发送的信息，解析出需要修改的信息，进行指定数据的修改，在修改完成之后，返回一条修改好的数据返回给上位机软件，告诉上位机软件修改后的数据，通过该模式可以大大提高电脑鼠的调试效率，免去了修改代码、重新下载程序等的重复的步骤。调试模式程序流程图如下图 9。

（4）DFS 是一种用于遍历或搜索树或图的算法，沿着树的深度遍历树的节点，尽可能深的搜索树的分支。而在电脑鼠到达终点时，电脑鼠在探索过程中的迷宫信息都将保留下来，将电脑鼠走过的轨迹创建为一个新的迷宫，将迷宫的数据导入到 DFS 算法中， DFS 的本质就是穷举法，DFS 开始遍历迷宫的各分支找出一个最短的分支。并将分支的位置信息保存在 Flash 中，用于电脑鼠返回的导航数据以及再次冲刺时的数据导航。DFS 算法程序流程图如下图 10。

3.3 上位机程序设计

上位机的系统流程图如图 11，上位机在与电脑鼠进行连接时需要选择电脑鼠与电脑蓝牙的端口以及波特率信息，当电脑鼠与电脑建立起连接后，电脑鼠会不断上传电压、运行模式等状态信息。在连接成功后并且电脑鼠处于调试模式时，上位机可以使用修改参数的功能，对电脑鼠的数据进行修改。如果电脑鼠处于探索模式下，程序主窗口会实时显示电脑鼠在迷宫的位置信息。