天津工业大学磁导航二队技术研究报告.docx
《天津工业大学磁导航二队技术研究报告.docx》由会员分享，可在线阅读，更多相关《天津工业大学磁导航二队技术研究报告.docx（46页珍藏版）》请在冰豆网上搜索。
天津工业大学磁导航二队技术研究报告
第六届“飞思卡尔”杯全国大学生
智能汽车竞赛
技术报告
学校：
天津工业大学
队伍名称：
天津工业大学磁导航二队
参赛队员：
陈帅
高鹏
王银鹏
指导老师：
荣锋
关于技术报告和研究论文使用授权的说明
本人完全了解第五届“飞思卡尔”杯全国大学生智能汽车邀请赛关保留、使用技术报告和研究论文的规定，即：
参赛作品著作权归参赛者本人，比赛组委会和飞思卡尔半导体公司可以在相关主页上收录并公开参赛作品的设计方案、技术报告以及参赛模型车的视频、图像资料，并将相关内容编纂收录在组委会出版论文集中。
参赛队员签名：
带队教师签名：
日期：
摘要
本文介绍了飞思卡尔电磁组智能车系统。
本智能车系统是以飞思卡尔16位单片机MC9S12XS128为核心，用电感检测赛道导线激发的电磁信号，AD采样获得当前传感器在赛道上的位置信息，通过控制舵机来改变车的转向，用增量式PID进行电机控制，用MATLAB、AUTOCAD等软件进行软硬件设计，用编码器来检测小车的速度，共同完成智能车的控制。
关键字：
电磁、MC9S12XS128、AD、PID
Abstract
ThisarticleintroducetheFreescaleintelligentvehiclesystemofelectromagnetic.Thisintelligentvehiclesystemusethemicro-controllerunitMC9S12XS128asmicro-controller,usemutualinductancecoilcollectiontrackinformation,useADtoextractthecurrentinformationontheline,tochangethecar’sdirectionbycontrollingtheservosteering,useanincrementalPIDtocontrolmotor,useMATLAB、AUTOCADandrelativesoftwaretodesignbothhardwareandsoftware,andweuserotaryencodertocalculatethespeedofthecar,andallofthesemakeitpossibletocontrolthecar.
Keywords:
MC9S12XS128PIDMagneticAD
第一章：
引言
“飞思卡尔”杯全国大学生智能汽车竞赛是由教育部高等自动化专业教学指导分委员会主办的一项以智能汽车为研究对象的创意性科技竞赛，是面向全国大学生的一种具有探索性工程实践活动，是教育部倡导的大学生科技竞赛之一。
该竞赛以“立足培养，重在参与，鼓励探索，追求卓越”为指导思想，旨在促进高等学校素质教育，培养大学生的综合知识运用能力、基本工程实践能力和创新意识，激发大学生从事科学研究与探索的兴趣和潜能，倡导理论联系实际、求真务实的学风和团队协作的人文精神，为优秀人才的脱颖而出创造条件。
该竞赛以汽车电子为背景，涵盖自动控制、模式识别、传感技术、电子、电气、计算机、机械等多个学科的科技创意性比赛。
比赛要求在大赛组委会统一提供的竞赛车模，飞思卡尔16位微控制器MC9S12XS128作为核心控制单元的基础上，自主构思控制方案及系统设计，包括传感器信号采集处理、控制算法及执行、动力电机驱动、转向舵机控制等，最终实现一套能够自主识别路线，并且可以实时输出车体状态的智能车控制硬件系统。
我们从2012年1月份开始着手准备此次竞赛，经过近六个月的努力最终完成了小车的制作并成功参赛，此间我们认真学习相关知识，合理分工，共同作战，完成了各个模块的制作与调试，共同研究讨论解决各种问题，在不断调试后最终确定了现在小车的传感器放置，机械结构及算法。
本文将从以下方面进行描述，硬件设计、机械机构设计、软件设计、开发平台及测试、总结与体会。
第二章、机械结构及布局设计
2.1磁场及相关知识
2.1.1电磁传感器特点
电磁组需要检测的信号为大小100mA，频率为20KHz的方波信号，赛道由导线铺成，导线周围分布着交变的电磁场，由于赛道的各种形状，使得磁场发生叠加，不同的赛道形状形成不同的特征磁场，正因为如此，我们可以根据磁场的不同对不同的赛道进行判断。
2.1.2电磁场理论
通有稳恒电流I长度为L的直导线，与导线距离为r处的P点，其磁感应强度为：
公式（2-1-1）
图2-1-1 直导线稳恒电流的磁场
由此得
公式（2-1-2）
对于无限长直导线来说，θ1=0，θ2=π，则有
公式（2-1-3）
图2-1-2 直导线稳恒电流磁场示意图
对于弯道的磁场是没有公式直接计算的，必须通过AD采集大量的数据，通过对数据的处理判断弯道磁场的变化规律，进而识别是小S，大S还是十字交叉等不同赛道形式。
2.2.传感器的布局
1.高度：
传感器的高度不同，其所对应的磁场变化曲线就不同，既不能太高，也不能太低。
一般取5——12cm，根据大量测量数据显示，在我们的固定方式前提下去8——9cm时曲线变化最好，故我们取传感器高度为8.5cm。
2．前瞻：
对于本次竞赛，大赛规定电磁组前瞻不限，理论上说前瞻越长过弯道越容易，越容易提速，但是前瞻越长，控制难度越大，对机械要求也越高，我们不能忽视摆臂太长会造成甩尾的现象，因此我们在不断调试中去发现最佳前瞻长度，进过不断地改变方案和测试我们最终确定前瞻为22cm，并确定下来进行下一步操作。
3.传感器个数及摆放方式：
选择传感器的个数多少往往是一件很令人头疼的事情，选择少了无法检测到整个赛道信息，选择多了控制难度太大，而且摆放位置、方式对磁场检测也有很大影响，我们共有如下三种方案：
（1）单排俩个：
这是最简单的放置方式，俩个传感器能识别大部分的赛道信息，控制得当能够使小车跑下来，但是一旦想要加速其弊端就显露无疑，很多位置的信息无法读取，判断不够精确等都制约了车的加速。
（2）双排，每排俩个再加竖直方向一个：
这种布局相对单排俩个来说有了明显改善，单排的监测范围有限，但是双排检测会弥补单排的漏洞，使检测范围更大，不容易漏掉磁场信息；竖直方向的传感器是用来检测十字交叉的。
（3）双排，前排四个，后排俩个，如下图所示
图2-2-1传感器方案三
传感器与水平面成30度角，这样磁场在x,y,z方向都有分量，通过对各分量大小的判断进而判断赛道及赛车位置，进而进行控制。
进过范围测试及实践证明，第三种方案是可行的，因此我们选用第三种方案
2.3智能车底盘的研究
图2-2-2B型车模
转向轮定位参数
对于汽车而言，要保持车辆直线行驶的稳定性，使之转弯自动回正、转向轻便，必须确定车轮定位参数，包括主销后倾、主销内倾、前轮外倾和前轮前束。
主销后倾角
主销后倾角在车轮偏转后形成一回正力矩，阻碍车轮偏转。
主销后倾角越大，车速愈高，车轮偏转后自动回正力越强，但回正力矩过大，将会引起前轮回正过猛，加速前轮摆振，并使转向沉重。
通常后倾角为1°~3°。
主销内倾角
在汽车前后方向上，主销向内倾斜一个角度，主销轴线与垂线间的夹角称为主销内倾角。
当汽车转向轮在外力作用下发生偏转时，由于主销内倾, 则车轮连同整个汽车的前部将被抬起一定高度，在外力消失后，车轮就会在重力作用下力图恢复到原来的中间位置。
通常主销内倾角不大于8°。
前轮外倾角
在汽车的横向平面内，前轮中心平面向外倾斜一个角度，称为前轮外倾角。
前轮外倾角一方面可以使车轮接近垂直路面滚动而滑动减小转向阻力，使汽车转向轻便；另一方面减少了轴承及其锁紧螺母的载荷，增加了使用寿命，提高了安全性。
一般前轮外倾角为1°左右，但对于有高速、急转向要求的车辆，前轮外倾角可减小甚至为负值。
前轮前束
俯视车轮，汽车的两个前轮的旋转平面并不完全平行，而是稍微带一些角度，这种现象称为前轮前束。
车轮前束的作用是减轻或消除因前轮外倾角所造成的不良后果，二者相互协调，保证前轮在汽车行驶中滚动而无滑动。
前轮前束一般为0~12mm。
而现代汽车的前轮外倾角出现减小甚至为负值的趋势，前轮前束也应相应减小甚至也为负值。
重心位置对汽车性能的影响
汽车重心的位置通常用重心距前轴中心线的水平距离和重心距水平路面的高度来表示。
可通过实验法、估算法测出重心位置。
对动力性能的影响
汽车正常行驶必须满足驱动－附着条件：
即汽车的驱动力必须大于等于坡度阻力、滚动阻力、空气阻力之和而等于汽车驱动轮的附着力。
附着力与路面附着系数和驱动轴的轴荷有关，而驱动轴的轴荷取决于重心的水平位置，故重心位置必须保证驱动轮能够提供足够的附着力。
仅从此方面考虑，重心越靠近驱动轴越好。
对制动性能的影响
汽车制动性要求制动减速度大、制动距离短，有良好的制动方向稳定性，即不易发生前轮丧失转向、后轮侧滑和跑偏现象。
制动方向的稳定性与前后轮的抱死次序有关，而抱死次序则与重心位置有关，若重心位置保证汽车的同步附着系数（β为前制动力占整车制动器制动力比例，b为重心到后轴水平距离）等于汽车常用路面附着系数，那制动稳定性即较好；若重心前移，b增大，易发生后轴侧滑，对高速汽车危险性大；若重心后移，b减小，前轮易丧失转向能力。
对通过性的影响
汽车在较陡侧坡行驶或高速急转弯行驶时，会发生侧向倾覆，为避免这种危险，重心应在保证最小离地间隙的前提下尽量降低。
综合上面分析，在加装诸多电路板后应尽可能保证模型车的重心垂直位置尽量的低，水平位置应在车中线上靠近后轴。
汽车侧滑
为保证汽车转向车轮无横向滑移的直线滚动，要求车轮外倾角和车轮前束有适当配合，当车轮前束值与车轮外倾角匹配不当时，车轮就可能在直线行驶过程中不作纯滚动，产生侧向滑移现象。
这种滑移现象过于严重时,将破坏车轮的附着条件，使汽车丧失定向行驶能力。
侧滑分为以下几种情况。
定向侧滑
随机侧滑
转向侧滑
制动侧滑
汽车在制动过程中若前轮先抱死拖滑，则将可能发生侧滑。
可以采取一些补偿措施减小侧滑。
对于定向侧滑，用前轮前束产生的Q类侧滑来补偿外倾产生的W类侧滑是基本手段。
Q类侧滑的性质为：
侧滑大小等于前束角大小；侧滑方向与前束角方向相反，与车辆行驶方向有关；与路面质量无关。
对于随机侧滑，主要是从改变独立悬架结构入手，如本车模的双横臂式独立悬架车桥车轮的随机侧滑可用四连杆机构综合理论改变上下横臂的长度，使模型行驶过程中轮距变化不大，从而减小随机侧滑。
对于转向侧滑，主要靠选择合适的主销角度，合理搭配主销内倾与后倾角，尽可能使转向内轮产生外倾或增加外倾，使转向外轮产生内倾或减小外倾。
模型车底盘性能
模型车底盘采用的是等长双横臂式独立悬架（如图1），当车轮上下跳动时，车轮平面没有倾斜，但轮距会发生较大变化，故车轮发生侧向滑移的可能性较大。
本车共有6处参数可调，其中主销内倾角对模型车性能影响不大，可设为。
图2-2-3 前轮前束调整
主销后倾角
主销：
转向轮围绕主销进行旋转，前轴的轴荷通过主销传给转向车轮,具备这两点的就叫做主销。
主销内倾和车轮外倾角度主要是由转向节决定的。
主销后倾角：
主销的轴线相对于车轮的中心线向后倾斜的角度。
前轮重心在主销的轴线上由于主销向后倾斜使前轮的重心不在车轮与地面的接触点上，于是产生了离心力，主销后倾形成的离心力，可以保证汽车直线行驶的稳定性还可以帮助车轮自动回正。
主销后倾角延长线离地面实际接触越远，车速越高，离心力就越大。
在高速行驶中保持汽车直线行驶的稳定性，适当的加大主销后倾角可以帮助转向轮自动回正，可有效扼制转向器的摆振，可使转向便轻，单独适量调一侧主销后倾角可修理行驶跑偏。
主销后倾角靠离心力保证汽车直线行驶和车轮自动回正。
高速行驶时跑偏可通过主销后倾角调节。
但主销后倾角过大会造成高速时转向发飘。
通常后倾角值应设定在1—3度。
前轮外倾角与
与模型车的侧滑关系较大，需与前轮前束相匹配，可设为1-12mm。
前轮前束
前轮是由舵机带动左右横拉杆实现转向的。
主销在垂直方向的位置确定后，改变左右横拉杆的长度即可改变前轮前束的大小。
左杆短，可调范围为10.8mm~18.1mm；右杆长，可调范围为29.2mm~37.6mm（如图红圈所示）。
图2-2-4
底盘离地间隙
在独立悬架下摆臂与底板之间可以通过增减垫片来调整底盘前半部分的离地间隙，垫片有1mm和2mm两种规格。
一片垫片不加，车前部离地间隙为9mm，故离地间隙的调整范围为9mm~12mm。
从已有的经验来看，在加装了传感器之后，此距离过小，会降低模型车爬坡时的通过度；过大，则会影响传感器的灵敏度。
舵机性能测试
在舵机的轴上连接一个变阻器，该变阻器有三个接头，两侧的接头一端接在5V电源上，另一端接地，中间的接头连在示波器上，示波器测电压。
当舵机带动前轮转动时，变阻器的阻值随之改变，示波器的电压值也发生变化，即将电压与舵机的转角对应起来，这样，通过测量电压随时间的变化即可知舵机转角的变化率。
从试验中可知，舵机近似匀速地由一侧最大转角转至另一侧最大转角。
结合对前轮最大转角的测量，可估测出舵机的转速约为2.42rad/s-2.52rad/s。
由汽车理论的相关知识可知，该舵机性能偏软，可通过增大前轮前束来进行调整。
对舵机性能的测试主要用于设定仿真参数，同时估算出的舵机转速也对程序相应速度和转向时的车速限制有一定的参考意义。
模型车稳态转向测试
本节探讨舵机PWM占空比与车速、转弯半径之间的关系。
试验中舵机PWM占空比设为6挡，分别以1、2、3、4、5、6表示，数字越大转角越大。
如图1为舵机转角为挡位1时的车速——转弯半径对应图，由试验可知，在相同转角下，转弯半径与车速大致呈线性关系。
根据模型车的相关数据由下式可算得理论转弯半径为275mm。
该值与模型车试验中0.31m/s时的转弯半径相近；当模型车车速>1.4m/s后开始出现侧滑现象。
在此基础上经过不断调整，我们确定了主销内倾角为2度，前轮前束为大约6mm.底盘对车的性能影响很大，最初我们只是简单的讲各个电路模块固定在车上，没有考虑太多的制约因素，但是随着速度的提高，我们越来越发现机械对车的重要性，软件、算法再好，机械达不到要求都是徒劳，因此我们花了不少时间修改机械，尽量将底盘较低，重心降低，并根据空气阻力等因素使车的结构更精简美观，最终收到很好效果。
图2-2-5整车底盘及结构
2.4舵机安装
舵机的安装位置对转向有很大影响，摆臂的长短也会影响到转弯的灵敏度和精度，理论上适当加长摆臂会提高转向灵敏度，且摆臂与车轮垂直时舵机灵敏度和精度更好，考虑以上因素我们选择了这样的安装方式：
图2-2-6舵机安装位置
第三章、硬件电路设计
3.1、信号采集电路模块
图3-1-1信号采集电路原理图
对于信号采集电路，我们没有采纳官方推荐的电路，主要原因是考虑到用三极管进行放大在静态工作点的调整上比较繁琐，且三极管的温飘现象比较严重，而对于运算放大器进行放大的电路，也有其缺点：
（1）、一般运放需要正负电源供电，而大多数集成电路板上没有负向电源，需要自己制作。
（2）、输出范围：
运放输出电压范围往往要比工作电源电压小1-2V，这样就大大限制了信号的范围。
也有部分CMOS运放可以实现满工作电源的输出（RailtoRail输出），但是这类运放的频率响应不够。
（3）频率响应：
普通的运放的频率响应特性由增益带宽乘积参数决定。
该参数一般在1-5Mhz左右，除了高速运放外。
我们的信号频率为20kHz，如果使用增益带宽乘积参数为1Mhz的运放，它对于20kHz的最大增益已经减少到50倍左右了。
此时，它的最大输出电压范围也会更加减少（主要受到输出电压转换速率参数的影响）。
此时运放电路增益已经不能够满足我们的需要。
综合以上信息，我们经过仔细挑选和考虑成本，确定了俩个方案：
（1）LM358运算放大器，LM358内部包括有两个独立的、高增益、内部频率补偿的双运算放大器，适合于电源电压范围很宽的单电源使用，也适用于双电源工作模式，在推荐的工作条件下，电源电流与电源电压无关。
它的使用范围包括传感放大器、直流增益模块和其他所有可用单电源供电的使用运算放大器的场合。
（2）LM324
LM324系列是价格便宜的带有真差动输入的四路运算放大器，于单电源应用场合的运算放大器相比，该运放的工作电压范围广，共模输入电压包括负电压，因而消除了在许多场合应用中需要外部转换电路的麻烦。
从成本上将，LM324更加便宜，且一个运放具有四路放大功能，但是在频率响应上其明显不足，与LM358相比差了不少，因此我们最终决定用LM358做放大功能芯片。
3.2、电源电路模块
图3-2-1电源电路模块原理图
舵机的工作电压为5V，而电池电压为7.2V，所以如果想要用电池直接供电需要有电压转换装置，将电池7.2V的电压转换成5V。
我们采用集成电压转换芯片LM2576-ADJ，此芯片使用简单方便，可以实现3.3V、5V、12V、15V等的稳压，用其典型电路即可。
3.3、电机驱动电路模块
电机驱动电路我们采用的是BTS7970，BTS7970是一款高电流的PN型半桥驱动芯片，最高耐压值达43A,且各种保护功能完备。
外形图及原理图如下
图3-3-1电机驱动电路
图3-3-2BTS7970电机驱动电路原理图
3.4、主控板电路模块
主控板电路我们采用了9S12系统芯片，外面扩展了一些接口电路和控制设备。
图3-4-1主控板
图3-4-2主控板原理图
3.5、起跑线检测模块
起跑线检测相对简单，我们用的是霍尔开关3144，这种霍尔开关能检测到一定范围的磁场信号，当磁场信号到来时，开关闭合，产生一个脉冲，通过对此脉冲计数控制即可实现起跑线检测。
计数1为出发通过起跑线，计数2为回到起跑线，此时只需给出停车指令。
第四章、软件设计
4.1、系统整体流程图
此智能车系统包括传感器（电磁传感器、速度传感器—编码器），电源模块，电机驱动模块等，整体流程图如下：
4.2、舵机转角控制策略
舵机控制就是赛车的方向控制，以赛车车体为参考系，控制前轮转向，始终使导线逼近赛车中心线，即期望位置。
电磁传感器获取赛道信息，经赛道提取得到实际赛道位置；期望位置与实际赛道位置的偏差用于增量式PID计算，得出控制舵机的PWM波占空比；舵机驱动前轮，控制赛车运动，使赛车与赛道的位置偏差最小。
图4-2-1舵机控制原理
根据增量式PID算法公式[10,11]：
公式（3-1）
设计舵机控制程序核心语句如下：
4.3、速度控制策略
速度控制就是控制小车的速度，根据传感器采集的数据判断小车所处位置是直到还是弯道，是大S、小S还是普通的弯道，对于直到是长直道还是短直道。
不同的道路状况给定不同的参数，小车按照不同的速度行驶。
从而使得小车在没有丢线的基础上以最大的速度行驶。
速度控制源代码：
intsudu（intdty）//速度
{
intsd;
if（DJ_flago==1）{
PORTE_PE5=~PORTE_PE5;//PORTE_PE5输出取反
DJ_flago=0;
if（dty>DJmid-150&&dty}
if（dtyDJmid+150||ch[2]>30||ch[3]>30）zdflag=0;//进入弯道
if（zdflag>=10）{
sd=flag1;//滤短直到
zdflag=10;
}
elsesd=flag0;
returnsd;
}
4.4、PID算法
4.4.1、PID算法简介
PID算法是目前工业上应用比较成熟的一种控制算法，广泛用于自动控制领域，它的结构简单，参数容易调整，有模拟PID调节器和数字PID算法两种。
细分又可分为增量式PID，位置式PID，模糊PID，各有各的优缺点。
图4-4-1PID结构式
4.4.2、PID三个参数的作用
PID参数的整定就是合理的选择PID三参数。
从系统的稳定性、响应速度，超调量和稳态精度等各方面考虑问题，三参数的作用如下：
1、比例参数KP的作用是加快系统的响应速度，提高系统的调节精度。
随着KP的增大系统的响应速度越快，系统的调节精度越高，但是系统易产生超调，系统的稳定性变差，甚至会导致系统不稳定。
KP取值过小，调节精度降低，响应速度变慢，调节时间加长，使系统的动静态性能变坏。
2、积分作用参数Ti的一个最主要作用是消除系统的稳态误差。
Ti越大系统的稳态误差消除的越快，但Ti也不能过大，否则在响应过程的初期会产生积分饱和现象。
若Ti过小，系统的稳态误差将难以消除，影响系统的调节精度。
另外在控制系统的前向通道中只要有积分环节总能做到稳态无静差。
从相位的角度来看一个积分环节就有90°的相位延迟，也许会破坏系统的稳定性。
3、微分作用参数Td的作用是改善系统的动态性能，其主要作用是在响应过程中抑制偏差向任何方向的变化，对偏差变化进行提前预报。
但Ti不能过大，否则会使响应过程提前制动，延长调节时间，并且会降低系统的抗干扰性能。
总之PID参数的整定必须考虑在不同时刻三个参数的作用以及相互之间的互联关系。
4.4.3、PID参数调节的一般方法
a.确定比例增益P
确定比例增益P时，首先去掉PID的积分项和微分项，一般是令Ti=0、Td=0（具体见PID的参数设定说明），使PID为纯比例调节。
输入设定为系统允许的最大值的60%~70%，由0逐渐加大比例增益P，直至系统出现振荡；再反过来，从此时的比例增益P逐渐减小，直至系统振荡消失，记录此时的比例增益P，设定PID的比例增益P为当前值的60%~70%。
比例增益P调试完成。
b.确定积分时间常数Ti
比例增益P确定后，设定一个较大的积分时间常数Ti的初值，然后逐渐减小Ti，直至系统出现振荡，之后在反过来，逐渐加大Ti，直至系统振荡消失。
记录此时的Ti，设定PID的积分时间常数Ti为当前值的150%~180%。
积分时间常数Ti调试完成。
c.确定积分时间常数Td
积分时间常数Td一般不用设定，为0即可。
若要设定，与确定P和Ti的方法相同，取不振荡时的30%。
d.系统空载、带载联调，再对PID参数进行微调，直至满足要求。
不同的速度对应不同的PID参数：
我们应用最简单的增量式PID。
计算PID源代码：
floatDoublePIDCalc（doubleGivenValue,doubleMeasureValue,PIDSING*pp）{
floatdError,Error;
Error=GivenValue-MeasureValue;/*计算Error*/
pp->IntegralPortionK_1=Error+pp->IntegralPortionK_1;/*计算SUMerror*/
if（pp->IntegralPortionK_1>pp->PositivePIDLimit）
pp->IntegralPortionK_1=pp->PositivePIDLimit;
if（pp->Inte
升级会员 