基于红外传感器的自主避障平衡车.docx

基于红外传感器的自主避障平衡车[摘要]本设计以2016年第十一届恩智浦杯智能车大赛为背景自主设计车模的硬件结构独自构思控制策略和算法结构以恩智浦公司生产的32位Kinetis系列单片机作为核心处理器硬件上采用MOS管驱动电机传感器上采用数字陀螺仪和数字加速度计综合检测车模的平衡角度用编码器反馈速度信息采用电磁传感器来检测赛道位置信息和检测采用红外传感器检测障碍物起并使用蓝牙、无线、液晶辅助调试以PID控制作为控制电机的主要算法原理最终控制车模达到在赛道上稳定直立行走并且遇到障碍能减速制动的效果。[关键词]k66微处理器红外传感器两轮电磁平衡车中图分类号：TV76文献标识码：A文章编号：1009-914X（2017）06-0140-020.引言近年恚国内外有很多关于两轮自平衡车的研究甚至已经生产出相应的代步产品。随着现代科技的发展对于自平衡的车身响应速度和姿态控制精确度提出了更高的要求。与此同时两轮自平衡直立车的智能化也是当前研究的另一大热点。如何更好地在无人操控的基础上实现这种平衡车的控制。可以说这体现了多学科领域的交叉和综合也是未来发展的趋势。[1]两轮自平衡小车是一个高度不稳定两轮机器人是一种多变量、非线性、绝对不稳定的系统是检验各种控制能力的典型装置。通过推导出小车自平衡条件计算最大可控角度并得到可控角度与路面摩擦因数间的关系。作者对可控角度的推导为系统数学建模和平衡控制的实现提供了重要的理论数据和理论依据。[2]自平衡系统是一种两轮左右平行布置结构类似于传统的倒立摆与蹊跷板平衡系统其本身是一个自然不稳定体同时两轮自平衡车在姿态控制过程中物理支撑部位直接与自然地面接触。这与一般的一级倒立摆运行在经过加工的导轨上不同虽然二者动力学模型类似但是其控制过程中受到的干扰因素更丰富因此两轮自平衡小车是研究各种控制算法性能的理想平台。[3][4]1.硬件设计本文所设计的平衡车选用了NXP公司KinetisK系列中的MK66FX1M0VLQ18。KinetisK系列MCU基于ARMCortex-M4F内核其适合需要高存储器密度、低功耗和高处理效率的应用。使用的姿态传感器为NXP公司最新的FXAS21002系列3轴陀螺仪与MMA8452Q三轴、电容式微机械加速度传感器加速度传感器其都具备超低功耗和先进的嵌入式特性特别适合应用在增强运动控制等应用。故大大提高了平衡车控制的系统稳定性及实时性而在红外传感器上选用了E18-D80NK-N红外传感器这款传感器最远可以检测80厘米距离的问题该传感器具有探测距离远、受可见光干扰小、价格便宜、易于装配、使用方便等特点可以广泛应用于机器人避障、流水线计件等众多场合。[5]整个系统的核心控制采用NXP的MK66FX1M0VLQ18型号单片机MK66FX1M0VLQ18是Kinetis系列双高速和全速USB2MB闪存微控制器基于ARMCortex-M4内核的K66微控制器主频180M144LQFP封装适合需要高存储器密度、低功耗和高处理效率的应用。该微控制器提供高速USB带集成高速USB物理收发器、SDRAM控制器、全速无晶体USB支持等功能其多达32通道的DMA用于外设和存储器可以降低CPU负载实现更快的系统吞吐功能。在本次平衡车设计中使用了MK66单片机的GPIOPITUARTIICFTMDMA等外设。[6]控制流程图为（图1）：由于平衡车需要保持直立状态运行运行时对车模的重心要求比较高为了能够充分降低车模的重心将主板和电机驱动电路做成一块PCB是最佳方案[7]主板电路图如图2。2.系统软件设计2.1直立控制平衡车姿态控制由直立环、速度环和方向环三个闭环构成其相互影响并相互制约。车模直立控制采用PD控制由加速度计和陀螺仪模块采集数据通过互补滤波算法运算得出配合PD控制使得平衡车保持直时立状态。互补滤波算法可以将获得的加速度数据与陀螺仪数据积分后得到的角度进行对比校正通过对比积分所得到的角度和重力加速度所得到的角度使用它们之间的偏差改变角度的输出从而积分后的角度逐步跟踪到加速度传感器所得到的角度从而保证实时性图为互补滤波后得到的角度信号（图3）。部分程序程序：voidAngleCalculate（void）{F4lnDeltaValue=0；lnDeltaValue=ACC_MMA8451_Z；if（CarControlFlag==0）//起跑直立lnDeltaValue=lnDeltaValue+Z_ZERO；