为路线指示；总长度设计为1m，路线开始为直线，垂直于木板底边，在坡顶转向90°，平行于木板顶边与顶边相隔距离为≤20cm，转弯半径为10cm～20cm，转弯完成后路线在延长≥30cm；停车标记设计为宽，长各为1cm，5cm。坡道设计：用长，宽各约为1m的木板搭建小车坡道，坡道角度可以任意调节。 图1 小车坡道角示意及行驶线路顶视图
1 小车方案选项
■1.1 理论分析
要求小车能够在不同倾斜角的木板上完成循迹，行驶速度均匀并且行驶时间可控，并且能够在终点稳定停止。若需要完成以上要求，需要对位于木板上的小车进行受力分析，小车的受力分析如图2所示。 abs-210由牛顿第二定律公式 F=m×a可知：小车静止在坡道时应满足：
mgsinθ≤μmgcosθ；摩擦系数应满足μ≥tanθ；小车在坡道匀速行驶应满足：F车=mgsinθ+μmgcosθ; 图 2 小车受力分析图
由以上分析得：小车若要在循迹时要做到匀速行驶、运行时间可控，在终点稳定停止，与小车的质量、动摩擦因数以及电机的力矩大小都有关联。
本系统采用超低功耗16位微控制器MSP430F5529作为系统设计的主控芯片[4-5]。
选用ST188反射式红外光电传感器进行循线。ST188由高发射功率光电二极管和高灵敏度光电晶体管组成。光电二极管由高电平触发，发射出红外线，若接收面为白，则返回信号至接收管，若为黑，则返回信号被吸收，接收管无信号。该传感器价格低廉，且多个红外传感器配合使用，能做到基本的循迹。
选用DC3V-6V减速直流电机，减速直流电机结构简单，易于固定，且便于驱动，通过单片机输出PWM至驱动电路即可控制电机的转速，电流小，不会烧坏电路。
选用编码器型号为512线mini增量式编码器作为测试模块。该编码器具有体积小、重量轻、精度高的特点，可读取的最大转速为10000rpm。使用简单，输出脉冲稳定，误差较小。
本系统采用6个ST188红外光电传感器对黑纸条进行信号采集，通过LM393电压比较器读取传感器返回的电平，由MSP430单片机的IO口获得比较后的电压，根据不同的电平组合判断小车状态。主控芯片输出PWM来控制电
数控分度头
20 | 电子制作 2021年06月
www�ele169�com | 21
智能应用
机的转速，来矫正小车的姿态，使小车能够沿标记线平稳行驶。同时通过编码器读取车轮转速，引入位置式PID 算法
对车轮转速进行精确控制。此外，系统还含有OLED 显示屏以及四个按键，以便于观测实时数据以及设置参数，通过
语音播报提示小车状态。系统硬件框图如图3所示。 图 3 系统硬件框图
2 系统电路设计
■2.1 电机驱动电路设计
本系统采用的电机驱动为TB6612FNG 模块，是一款直
流电机驱动器件，它具有大电流MOSFET-H 桥结构，双通
道电路输出，可同时驱动2个电机。驱动控制逻辑如下：芯片VM 直接接电池电源，VCC 内部逻辑供电，STBY 置高
的正反转，PWA 接单片机PWM 输出口控制电机转速，原理图如图4所示。
图 4 TB6612FNG 驱动模块原理图
■2.2 主控板电路设计
本系统选择的主控为MSP430F5529，原理图如图5所
示。对MSP430F5529 进行资源拓展，板上搭载5.0V、3.3V
稳压电路以及部分模块接口，其中稳压电路为每个接口模块进行供电，OLED 显示屏用于显示小车运行时的位置和速度信息，配合四个独立按键可进行小车的模式选择以及参数设定，小车的运行每个模式以及最后停止时都由语音模块实时
播报，拓展板资源。 ■2.3 系统电源电路设计
系统MCU 和各种外设在正常供电的情况下才能正常工
作，此时MCU 才能正常接收信号和处理信息，整个系统的电源需要多种供电接口，电机驱动需要电池电源，MCU、
OLED 显示屏需要3.3V 供电，语音播报、编码器、需要
5V 供电。3.3V、5.0V 电源分别使用LM2596-3.3V、
LM2596-5.0V 对电池电压进行降压，可调电源通过电位器进行电压调节，调节范围为6~25V，由LM2596-ADJ
电源芯片来实现电压输出，每个电路输出都外接五组排针，完全能满足对电源的需求，同时每组电路都包含LED 指示灯，能够实时观测电路的状态。电路原理图如
图6所示。
■2.4 红外循迹电路设计本系统选用6个ST188红外光电传感器对标记线进行识别，ST188通过发射端的光电二极管发射红外光线，接收端通过高灵敏度晶体管接收反射回来的光线输
出对应的电平信号，再进入
22 | 电子制作 2021年06月
LM393电压比较器与其基准电压进行比较，使MCU 的IO
口能够读取到稳定的电平。在电路设计中，将发射管处串联
的电阻选为100Ω，以便发射管能够发射高强度的红外信号。电压比较器LM393的基准电压由一个10k 的电位器进行调节，在OUT 输出口处接上一个上拉电阻，用于保护MCU
的IO 口，同时再接一个LED 指示灯，以便使用时能够直观的看到输出电平。部分电路原理图如图7所示。
3 系统软件设计
■3.1 位置式PID 算法
通过编码器读取小车的速度，通过位置式PID 算法对
小车速度进行闭环控制，PID 控制是一种常见的反馈控制，
由比例(P)、积分(I)、微分(D)组成。比例控制为基础控制，积分控制为消除稳态误差，微分为加快系统的响应速度。P、I、D 分别对应现在、过去、将来，分别对系统进行调节修正，减少系统误差，理想连续控制的公式如下[6-8]：
()()()()()0
1t
p d
i
de t u t K e t e t dt T T d t
=
++液压缸位移传感器
∫
其中p K 为比例系数、i T 为积分时间常数、d T 为微分时
间常数、()e t 为实际值与设定值的差、()u t 控制为输出值。经过多次参数的整定，小车循线运行效果最优的参数为：
P=6.35；I=1.36；D=0.63。
■3.2 软件设计
该系统最重要的部分在
于小车的自动循迹，MCU 通过GPIO 口读取红外光电传感器所返回的电平来判断自身在标记线上的位置，输出不同的
PWM 控制电机转速，从而实现小车在标记线上的自动循迹以及终点停车。对电机采用位置式PID 算法进行闭环控制。
此外，采用模拟IIC 控制OLED 显示一个菜单。菜单包括速度，
图 6 系统电源模块原理图
OUT11IN1-2IN1+
3GND 4
VCC 8
OUT2
7IN2-6IN2+5
U2
LM393
100R
R410K
R510K
R3
10K R610K R7100R
R8510R
R1510R
R25V
5V
GND
O U T 1
O U T 2
柔性电路5V
5V D1
D2
OUT1
OUT2
5V
GND
GND
LED 红LED 红
U3 红外对管
U1 红外对管
图 7 红外循迹电路图
开始
OLED 、PWM 、KEY 、UART 、PID 、
寻迹IO 、编码器初始化
N
红外读取的值以及小车的各种参数，其中菜单光标的移动以及参数调整由四个普通按键完成。小车的语音播报由MCU 的
4 试验系统测试
■4.1 测试方案
对该系统进行测试时，需要用直尺对赛道各部分长度进行测量，检查赛道是否符合标准。小车在不同的模式运行时，通过秒表记录小车循迹时间。在小车稳定停在终点时，使用直尺测量小车上的标记点到停车标记中线的距离。测试小车在不同高度下的数据时，需要使用手机上的“指南针”APP 对斜坡进行角度设定。
■4.2 测试结果
试验一：设定木板坡度角θ=0°，要求智能小车在12s、15s、18s设定时间循迹自动行驶不能脱离标记线且准确停在停车标记点处误差≤2cm（即小车上标记点到停车标记中心线的垂直距离误差），试验数据如表1所示。表1 距离误差
设定时间/s121518
碾压或脱离标记000
卡顿/次000
实际行驶时间/s12�2014�8318�11
时间误差/s+0�20-0�17+0�11是否满足误差是是是试验二：设定木板坡度角θ=0°，将循迹线长度设定为1m长，时间设定为13s、16s、19s时间内循迹自动行驶不能脱离标记线且准确停在停车标记点处时间误差≤1s，试验数据如表2所示。表2 时间误差
设定时间/s131619
碾压或脱离标记000
卡顿/次000
行驶时间/s13�5116�6419�09
时间误差/s+0�51+0�64+0�09
是否满足是是是试验三：设定木板坡度角θ=0°～42°，将循迹线长度设定为1m长，时间设定15s，循迹自动行驶不能脱离标记线且准确停在停车标记点处误差≤2cm，时间误差≤1s，试验数据如表3、表4所示。
表3 15°～25°坡度数据表格
角度15°20°25°
碾压或脱离标001
卡顿/次112
设定时间/s151518
行驶时间/s15�6315�5518�89
时间误差/s+0�63+0�55+0�89
是否满足是是是
表4 30°以上坡度数据表格方波信号发生器
角度30°36°42°
碾压或脱离标011
卡顿/次245
设定时间/s151515
行驶时间/s15�5315�8715�95
时间误差/s+0�53+0�87+0�95
是否满足是是是通过在不同角度下记录小车的碾压或脱离标记线次数、卡顿次数、行驶时间的偏差、以及在终点稳定停车次数可知，随着坡道高度的增加，小车停顿的次数逐渐增加，其行驶时间与设定时间的偏差也随之增加。由于小车加入闭环控制，其碾压或偏离标记线的次数一直在可控范围内，经
过多次的测试，小车能完成循迹要求的最大角度为42°。
■4.3 试验分析
（1）小车出现碾压或脱离标记线主要是因为在拐角处转弯时红外传感器出现误判或者漏判，导致小车没有做出正确的姿态调整，出现碾压甚至脱离标记线的情况。（2）小车在行驶时的卡顿现象：一是因为在转弯时车轮的重心不稳，导致小车左方轮子出现悬空现象，无法实现小车的差速转弯而停在拐点；二是小车红外传感器精度不高，再加上循迹线仅为1cm的黑白标记线，小车无法完全实现无卡顿的循迹。
（3）小车实际行驶时间与设定时间出现偏差：一是因为小车在拐弯处的卡顿，增加了小车行驶时间；二是随着高度增大，小车运行时所受到的反作用力也随之增大。
5 总结
通过采用MSP430/MSP432平台设计智能小车电机驱
（下转第29页）
www�ele169�com | 23
最后发送要写的数据，按照对应的高字节与低字节。写寄存器的方式是根据前面命令码规定的内部写寄存器会自动加1是在数据发送完后。真实的光照值是由核心控制器STM32F103VET6读取的高字节与低字节合成。图7所示为
4 结语压水堆核电厂的运行
本文将ZigBee技术、嵌入式技术、传感器技术等与照明系统相结合，采用模块化设计方法。该系统依靠照度传感器、人体红外传感器等对教室的照度、使用状态、人员的数量及位置等信息进行自动采集，
由ZigBee模块WL T2408NZ无线通信统传递给STM32的主控制系统，根据实际需求，主控制系统对采集的数据信息进行分析、并发出控制信号，控制执行单元做出相应的动作。该系统将对教室照明所耗能源有很大程度上的节约，高校能源的浪费上有很好的杜绝，使高校照明财政负担有很好的缓解。高校教室智慧照明系统实现后，在使用时可灵活的升级系统，系统整体结构性好。高校教室智慧照明系统能实现智能化管理，在管理过程中具有一定的人性化，该系统具有一定的抗干扰能力，稳定性较强，电路之间电磁干扰小，工作可靠，易操作
的特点。
参考文献
＊ [1] 张峰.基于STM32的高校教室智慧照明系统的设计与实现西安建筑科技大学[D].西安建筑科技大学,2018.
＊ [2] 程春.大学教室智能照明控制器及其系统的研究与开发[D].北京化工大学,2010.
＊ [3] 汪显波.高亮度LED背光源设计[D].合肥工业大学,2007.＊ [4] 张静.实时焊缝图像有效信息获取及管理技术研究[D].中北大学,2007.
＊ [5] 冯义飞.教室照明智能控制的设计与开发[D].合肥工业大学,2007.
动电机电路、主控板控制电路、电源电路、红外循迹电路等相关硬件设计。利用位置式PID算法，进行智能小车运动控制。测试智能小车在不同坡度、不同时间坡道平稳运行、标记线上循迹效果良好，偏离误差≤1cm，且运动时间可控，能够在终点稳定停车，最大行驶倾斜角可达42°。该系统设计具有响应速度快，控制精度高等有点。
参考文献
＊ [1]王信乐，刘祚时.基于线性CCD的智能小车循迹系统设计与研究[J].制造业自动化,2020,42(08):79-84.
＊ [2]李明法，李媛媛.基于光流和超声波的智能小车障碍物检测系统[J].传感器与微系统,2020,39(08):103-106.＊ [3]胡徐胜，刘娟.一种带多路选择的智能循迹小车优化设计[J].控制工程,2020,27(07):1131-1135.
＊ [4]刘明强，王成，刘迅，张正祥，邓睿.基于MSP430F5529的电池管理系统[J].电源技术,2015,39(12):2608-2611.
＊ [5]张惠玲，周金治，郑希.一种基于MSP430F5529的锂电池组均衡方法及实现[J].电源技术,2015,39(08):1652-1653+1696.＊ [6]战俊彤，付强，段锦，张肃，高铎瑞，姜会林.利用位置式数字PID算法提高DFB激光器驱动电源稳定性[J].红外与激光工程,2015,44(06):1757-1761.
＊ [7]王剑颖，梁海朝，孙兆伟.基于对偶数的相对耦合动力学与控制[J].宇航学报,2010,31(07):1711-1717.
＊ [8]杨庆江.基于模糊PID技术的压电式气体压力测控系统[J].压电与声光,2008(05):652-654.
（上接第23页）
www�ele169�com | 29
豫公网安备41160202000603
站长QQ:729038198
关于我们
投诉建议