基于电磁场寻线智能车传感器的布局及控制策略基于电磁场寻线智能车传感器的布局及控制策略
本设计是以“飞思卡尔”杯全国大学生智能车竞赛为背景的电磁场检测的寻线智能汽车。系统的特点是充分利用磁
场检测传感器的布局来识别路径,以达到在速度较快的情况下控制小车的舵机转向。本文主要介绍了传感器的
布局方法和转向与速度的控制策略。
引言
以通电导线产生的磁场对智能车进行引导的优点在于不受光线、温度、湿度的影响,外界干扰小,控制可靠。但是以往的电磁
车的传感器布局一般为单排,其缺点是只能确定传感器相对于赛道中心的位置而不容易判断出车身的位置,导致转向时不能得
到最佳的控制策略。因此本设计实验了双排传感器的方案。理论分析和实践证明,双排传感器的布局方法比单排传感器信息量
大,控制线性化好,转向和速度更为优化。
1 设计原理
1.1 基本原理
根据电磁学基本理论,我们知道比赛赛道上的导线在通入了20 Hz、100 mA的电流后产生磁场。
在此稳恒磁场中放置一电感线圈,线圈中感应电动势的大小正比于电流的变化率,反比于线圈中心到导线的距离。公式如下:
其中k为与线圈摆放方法、线圈面积和一些物理常量有关的一个量。该公式说明,在导线周围不同位置,磁感应强度的大小和
方向不同,电磁传感器在不同位置获得的信号强度也不同,由此可以确定赛车前方的转向和车身当前位置。
1.2 本车传感器的布局及设计
图1 传感器布局图
我们在小车前方50 cm采用三个电感线圈与中心导线相垂直、两个电感线圈与中心导线相平行的方式来布局,主要用于判断小
车将要进入的赛道道路弯曲程度和路况。在小车前方15 cm处与中心导线相垂直的方向放置两个电感线圈,来判断小车车身当
前偏离中心线的位置,还可以判断车子是入弯还是出弯。整个系统电磁检测传感器的布局如图1所示。
图2 垂直布局传感器感应电势与中心导线的位置关系
当车模在直道上从左至右水平移动时,前排和后排垂直放置传感器的感应电势值与中心导线的位置关系如图2所示。数据均经
过了滤波、限幅和归一化处理。
从图2可以看出,传感器垂直布局时,在直道上偏离中心线越远,感应电势值越小。采用多个传感器对称布局而不是单一传感
器的优点在于不仅能计算偏离距离,而且能得出偏离方向,简化系统硬件设计。
前排另外两个电感线圈水平竖直放置,在直道上与赛道中心导线成平行方向,因此其在直道上所感应电势值较小,如图3所
示。而在弯道上,由于与中心导线具有一定角度不再平行,这两个电感线圈感应电势的绝对值和变化率均变得较大,所以用其
检测前方道路弯曲程度和小车面临转向角度是可以考虑的较好方案。
图3 平行布局传感器感应电势与中心导线的位置关系
2 数据采集和处理
2.1 检测信号采集
为了能不失真且放大倍数较大,在经过了三极管分立元件、LM386集成运放和NE5532的测试后决定用NE5532来作为磁场检
测信号的放大模块,并用肖特基二极管在作为检波元件,其原理图见图4。
放大倍数决定于可调电位器P2的值比上R1的阻值(10 kΩ),是可以调节的。一般将信号放大300倍,使其最大值达到3~5 V
较为理想。
2.2 检测信号处理
经过A/D转换存入单片机的采集数据需要进行处理才能用于控制。首先,针对磁场检测信号易受干扰的特点,对数据进行了平
均值滤波、限幅等处理;针对电感元件参数的杂散性和安装误差等情况,根据电感感应电势扫描的极大极小值对采集数据进行
了归一化处理;根据关系曲线的畸变情况,对数据进行了削顶限幅和修正补偿。
3 转向和速度控制策略
PD控制策略是智能汽车速度与转角控制的较佳方案,但需将通常的PID控制算法进行修正和完善。