0
  • 聊天消息
  • 系统消息
  • 评论与回复
登录后你可以
  • 下载海量资料
  • 学习在线课程
  • 观看技术视频
  • 写文章/发帖/加入社区
会员中心
创作中心

完善资料让更多小伙伴认识你,还能领取20积分哦,立即完善>

3天内不再提示

运用电磁导航技术实现小车智能的设计方案

电子设计 来源:互联网 作者:佚名 2018-01-11 07:25 次阅读

为了实现智能小车稳定快速的自动寻线,采用了“五横二竖加八字”排列的电磁线圈,能识别各种复杂的赛道。通过三次函数算法求出偏差,并采用差速电机算法处理弯道,实现了电磁导航的功能。实践证明,该系统能精准地控制智能小车稳定快速地运行,且达到了预期效果。航
智能小车寻线道路设计要求是:在中间铺设了一条直径为0.5 mm的铜质漆包线,漆包线中有频率范围为20±2 kHz、电流范围为50~150 mA的正弦波信号。随着智能小车的发展,需适应更加复杂的赛道,例如直角弯、坡道、障碍等。文中设计的智能小车,是基于Kinetis K60单片机开发实现的,以电磁线圈作为感应传感器,采用偏差算法控制小车精准的寻线功能,从而实现智能小车智能快速稳定的寻线行驶。
1 硬件总体设计
智能小车系统由Kinetis K60主控模块、传感器模块、舵机控制模块、电机驱动模块、OLED显示模块、拨码开关模块、编码器测速模块、停车检测模块、障碍检测模块这9个部分构成。系统总体框架如图1所示。


除了以上9部分外还有电源模块,整个智能小车由7.2 V镍镉电池供电,其中由LM1117稳压芯片输出3.3 V为主控芯片K60、拨码开关模块、停车检测模块、OLED显示模块提供电源。由一块LM2940稳压芯片得到5 V电压单独供给传感器模块,另一块LM2940稳压芯片得到5V电压分别供给蓝牙调试模块、障碍检测模块、编码器测速模块和电机驱动模块,此外,通过试验可发现,S3010 Futaba舵机可直接加7.2 V电压,此时舵机的响应速度也会提高,所以可直接将电池电压作为舵机的电源。舵机控制模块和直流电机均用7.2 V电压驱动。
电磁线圈采集到的交变电压信号经双运算放大器MAX4451放大后,通过二极管的二倍压检波电路将交变的电压信号检波形成直流信号,然后再通过单片机的A/D转换电路进行采集,获得正比于感应电压幅值的数值。
智能小车是以双电机方式工作,故采用4块BTS7971作为驱动芯片。BTS7971由一个p沟道的高边MOSFET和一个n沟道的低边MOSFET结合一个集成的驱动IC,形成能经受大电流通过的H桥的半边。因此4个BTS7971便能进行连接构成两个H全桥,进而实现电机的正反转。此外,使用 74HC244N三态八缓冲器隔离电机驱动模块,可防止电机转动产生的干扰信号灌入主控芯片而致损坏。
采用常开型塑封干簧管作为检测元件。在道路的起点和终点处埋有永久磁铁,当小车经过磁铁时,干簧管闭合,进而将这种信号传递给CPU,实现停车功能。将两个接近开关分别安装在小车两边对障碍进行检测。正常情况下,两个接近开关处于关闭状态0。通过调整好接近开关的检测距离,当道路某一边的障碍物进入接近开关的检测范围后,接近开关一直保持导通状态1,将这种信号的0和1变化传递到CPU,即可实现小车的障碍检测功能。
2 智能小车电磁寻线
2.1 传感器布置结构
采用“五横二竖加八字”排列的电磁线圈,如图2所示。此结构能使小车在直道、直角弯、S弯、十字弯,坡道上自主稳定地寻线行驶,具有抗干扰性强、稳定性高、机械强度高等特点。在高速运行的情况下仍能保持稳定的导航功能。


2.2 三次函数算法
在使用三次函数算法前应先进行预处理,以便快速利用三次函数求出偏差。预处理包括采样,求平均值,数据排序和归一化处理。由于不同道路的磁场强度会有所不同,先采样可获得道路磁场强度的最大值和最小值,这样智能小车对于不同道路的适用裕度会更宽,在实际投入生产和使用中有重要作用。三次函数算法的处理流程,如图3所示。


智能小车在初始化程序后,通过采样,取得各个电磁线圈在此赛道上磁感应电压的最大值和最小值分别储存在数组ad max[i]和ad min[i]中,以便系统快速高效地从数组中取值做比较,从而实现归一化。
每个电磁线圈采集5次磁感应电压后,通过去除其最大值和最小值求出平均值;这样起到了软件滤波的作用,减小了偶然误差。连续取5个平均值按时间先后进行排序并储存在二维数组ad3[i][5]里面,使得数据不断地更新,以便求出其加权平均值,减小系统误差。
求排序后平均值的加权平均值,取得与最后一次采集到最接近的磁感应电压值,再将每一个电磁线圈的加权平均值储存在数组ad4[i]中;将ad4[i]逐个与ad max[i]和ad min[i]比较:当ad4[i]>ad max[i],贝ad[5]=1.0;当ad4[i]采用三次函数算法和固定斜率变化融合方法。在一定范围内,三次函数计算的偏差较精确,一旦超过该范围,则融合“一”字电感的变化,尽量使偏差的变化线性化。采用这种方法的优点是在进行各种弯道的判断、处理,尤其是对直角的处理,能做到稳定、准确、快速地使系统做出判断。各电磁线圈偏移赛道中心线的距离z 和归一化后的磁感应电压值ad5[i]的关系如图4所示。


假设曲线的三次函数为
y=ax3+bx2+cx+d (1)
式(1)中y=ad5[i],x为电磁线圈偏移赛道中心线的距离,取图2中传感器1、4、6、9的ad5[i]作为y值;此时x分别为-12,-6,6和12,由此可解出a,b,c,d值。
对式(1)三次函数求导后为
y’=3ax2+2bx+c (2)
将上述程序中求得的a,b,c,d值代入式(2)即可得到偏差x。
上述理论计算得出的偏差与实际的偏差总会因为机械等原因存在一定的误差,为了减小该误差,加入了偏差曲线拟合环节。再通过对偏差拟合进行补偿,使得曲线拟合得到改进。这样大幅减小了偏差,最大限度地提高了拟合的精度。将小车实际的偏差x和理论计算得出的偏差y,使用Matlab曲线拟合工具箱做曲线拟合便可得到相应的曲线拟合方程。偏差拟合曲线曲线拟合情况如图5所示。


3 智能小车速度控制
3.1 增量式PID控制
上述曲线拟合补偿出的偏差又实时快速地变化着,正可用于小车速度的控制。小车系统采用增量式PID控制算法,其结构简单,具有高适应性、易调整参数性,对于控制模型不准确、参数变化大的控制对象,此方法可得到满意的结果。因其输出每次只有控制变量,可通过简单的逻辑判断来降低故障的输出,以避免了系统故障的发生。其控制方法如下


h.jpg
3.2 差速电机算法
为使智能小车在过弯道时的路线更佳、速度更快、平稳性更高,小车在上述增量式PID控制算法中加入了差速电机算法,即采用闭环有差反馈式调节系统实现小车的差速策略。为达到差速电机的目的,将小车差速电机的数学模型搭建如图6所示。


假设V1为左电机速度;V2为右电机速度;R为弯道半径;L为前后轮的间距,最优路径的转向角为αu,则小车的平均速度为


这样便可根据实际情况需要,来调整预设的期望速度大小。编码器通过采样电机转过的齿轮数转化成电信号,即可当做单片机脉冲的触发信号,单片机通过对脉冲计数就可得到转速的具体数值,再将该转速减去期望转速,然后乘以对应系数,得出脉冲宽度调制的占空比。根据上述三次函数拟合出的偏差大小,单片机就可用增大或减小占空比反馈的方法实现对电机的加减速控制,从而实现电机的差速运行。
4 结束语
介绍了一种智能小车在磁导航过程中磁感应信号的处理方法,采用了“五横二竖加八字”排列的电磁线圈,通过三次函数算法算出小车相对路径中心的偏差,辅之以差速电机算法,在高速运行的情况下仍能保持平稳精确的运行状态。测试表明,该算法具有良好的实时跟踪性和准确性。

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉
  • 智能小车
    +关注

    关注

    87

    文章

    549

    浏览量

    81664
  • 电磁导航
    +关注

    关注

    2

    文章

    7

    浏览量

    3832
  • 传感器模块
    +关注

    关注

    1

    文章

    30

    浏览量

    8657
收藏 人收藏

    评论

    相关推荐

    导航分析仪的技术原理和应用场景

      导航分析仪的技术原理  信号接收与处理:信号接收:导航分析仪能够接收来自导航卫星、地面导航基站等发射的
    发表于 11-19 15:13

    智能呼叫、激光导航、自动避障,为什么AGV机器人被需要?

    AGV机器人通过感应、导航技术提升制造灵活性,满足定制化需求,节省人力成本。AGV小车智能制造系统交互,实现高效生产。新兴
    的头像 发表于 10-23 18:08 158次阅读
    <b class='flag-5'>智能</b>呼叫、激光<b class='flag-5'>导航</b>、自动避障,为什么AGV机器人被需要?

    什么是AGV小车?有什么功能?适用于哪些场景?

    搭载不同的负载,实现物料在不同工位、仓库、生产线之间的自动搬运。这大大减少了人工搬运的工作量,提高了工作效率。 自动导航: AGV小车通过不同的导航方式(如磁性感应、激光感应、视觉感应
    的头像 发表于 10-12 11:10 491次阅读
    什么是AGV<b class='flag-5'>小车</b>?有什么功能?适用于哪些场景?

    AGV小车在智慧工厂中如何精准定位

    AGV导航需解决定位问题,激光导航技术准确安全,适用于多种环境。AGV小车具备高精度、灵活性、智能化管理和车身控制功能,与MES系统交互确保
    的头像 发表于 10-11 17:59 197次阅读
    AGV<b class='flag-5'>小车</b>在智慧工厂中如何精准定位

    20.0-电磁杆的组装和实物介绍“这个是就是你想要的“-智能电磁电磁循迹小车

    电子设计大赛20.0-电磁杆的组装和实物介绍“这个是就是你想要的“-智能电磁电磁循迹小车 电磁
    的头像 发表于 08-20 11:07 394次阅读
    20.0-<b class='flag-5'>电磁</b>杆的组装和实物介绍“这个是就是你想要的“-<b class='flag-5'>智能</b>车<b class='flag-5'>电磁</b>组 <b class='flag-5'>电磁</b>循迹<b class='flag-5'>小车</b>

    20.3-使用两个通道进行电磁循迹 智能车竞赛 电磁杆原理图 电磁循迹小车 STM32电磁小车 电磁循迹算法

    20.3-使用两个通道进行电磁循迹 智能车竞赛 电磁杆原理图 电磁循迹小车 智能
    的头像 发表于 08-20 10:56 653次阅读
    20.3-使用两个通道进行<b class='flag-5'>电磁</b>循迹 <b class='flag-5'>智能</b>车竞赛 <b class='flag-5'>电磁</b>杆原理图 <b class='flag-5'>电磁</b>循迹<b class='flag-5'>小车</b> STM32<b class='flag-5'>电磁</b><b class='flag-5'>小车</b> <b class='flag-5'>电磁</b>循迹算法

    20.2-电磁杆在磁轨道的测试 零基础入门智能车竞赛 STM32电磁小车

    20.2-电磁杆在磁轨道的测试 零基础入门智能车竞赛 智能车竞赛 电磁杆原理图 电磁循迹小车
    的头像 发表于 08-20 10:52 589次阅读
    20.2-<b class='flag-5'>电磁</b>杆在磁轨道的测试 零基础入门<b class='flag-5'>智能</b>车竞赛 STM32<b class='flag-5'>电磁</b><b class='flag-5'>小车</b>

    智能家居系统设计方案

    随着科技的飞速发展,智能家居已成为现代家庭追求高品质生活的重要趋势。智能家居系统通过集成各种智能设备,利用物联网、云计算、大数据等先进技术实现
    的头像 发表于 07-23 15:28 1468次阅读

    复杂电磁环境模拟系统设计方案

    智慧华盛恒辉复杂电磁环境模拟系统的设计方案是一个综合性的工程任务,涉及多个方面的考虑和技术实现。以下是一个基于现有技术和应用需求的
    的头像 发表于 07-17 17:06 378次阅读

    电磁频谱数据综合管理系统设计方案

    智慧华盛恒辉电磁频谱数据综合管理系统的设计方案是一个复杂且精细的过程,旨在实现对无线电频谱资源的全面监控、分析和管理。以下是一个基于当前技术和应用需求的
    的头像 发表于 07-15 17:19 419次阅读

    电磁频谱管理系统设计方案

    智慧华盛恒辉电磁频谱管理系统设计方案是一个综合性的项目,旨在有效地管理和利用电磁频谱资源,确保各种无线通信服务的顺畅进行,并避免频谱资源的冲突和浪费。以下是一个基于当前技术和应用需求的
    的头像 发表于 07-15 16:40 418次阅读

    电磁轨迹预测分析系统设计方案

    智慧华盛恒辉电磁轨迹预测分析系统的设计方案是一个综合性的项目,它结合了电磁学、运动学、数据分析以及可能的人工智能或机器学习技术,以
    的头像 发表于 07-15 16:22 372次阅读

    电磁继电器的原理是什么?为什么要使用电磁继电器?

    电磁继电器是一种利用电磁原理实现控制和保护的电器元件。它主要由电磁铁、触点系统、弹簧等部分组成。电磁继电器的工作原理是利
    的头像 发表于 06-21 09:24 1462次阅读

    AGV小车上的惯性导航模块运用——SGPM02

    之前我们介绍过SGPM01系列陀螺仪模块在智能泳池清洁机器人导航方案(SGPM01)。这款惯性导航模块收到了许多企业的欢迎。由此,爱普生推出了SGPM02系列陀螺仪模块通过惯性
    的头像 发表于 05-13 16:40 677次阅读
    AGV<b class='flag-5'>小车</b>上的惯性<b class='flag-5'>导航</b>模块<b class='flag-5'>运用</b>——SGPM02

    炬芯科技携手圆周率智能推出全球离线地图导航方案

    引擎技术实现了在智能手表等智能终端设备上的全球离线地图导航功能,为用户带来了更为便捷和高效的使用体验。
    的头像 发表于 03-18 13:37 429次阅读