智能车模块源程序+很具体.docx

《智能车模块源程序+很具体.docx》由会员分享，可在线阅读，更多相关《智能车模块源程序+很具体.docx（19页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、智能车模块源程序+很具体智能车模块源程序+很具体由于今年组委会光电池和照相机的单独竞争因而，我们选择光电池作为传感器部分。在比赛中，我们以汽车的速度记录了结果。为了使汽车跑得更快、更稳定，传感器的探测距离必须很远，这就需要很高的预见性。随着探测距离的增加，普通红外管的功率越来越小，干扰越来越严重。因而，我们制作了一个大功率管，同时采用了程控脉冲发光的方法，有效地减少了加热，提高了系统的稳定性系统采用7.2伏2000毫安镍镉电池作为系统能源，6伏由稳压电路隔离，5伏分别给舵机和单片机供电DC电机驱动模块接收速度控制信号，控制驱动电机运行，进而控制车速。转向伺服模块控制舵机转向，进而控制智能车转向

2、测速模块实时测量智能车辆的速度，用于系统车速的闭环控制，以准确控制车速。系统充分利用了MC9S12DG128单片机的外围模块。详细模块包括模数转换模块、定时器模块、脉宽调制模块、中断模块、输入输出端口和实时时钟模块等。在调试系统的经过中，使用了组委会提供的代码调试环境CodeWarriorIDE，并使用清华大学的Plastid2软件进行了仿真测试。图1.1系统构造图第三届全国大学生智能汽车大赛3.1转向器部分为了使转向愈加灵敏，对转向器相关部分进行了一些改动首先，我们将转向机臂加长了85毫米。这样，对于一样的转向角值，只需要较小的转向齿轮转向角，进而减少了转向齿轮转动时惯性造成的缺点。其次，我

3、们反向安装转向器，使转向器连杆水平，由于转向器提供的所有力都用于转向。3.2前轮部分为了增加前轮转弯时的稳定性，对前轮的相关部分进行了一些改动首先，改变前后垫片的数量，使前轮主销向后倾斜，使车轮具有更好的自动定位功能其次，改变连杆的长度，使车轮向外倾斜。当车轮转动时，前半部分的重心上移，使汽车转向愈加稳定。第三，通过改变转向机连杆的长度，我们增加了前轮的前束，这也增加了前轮的稳定性。3.3底盘部分为了提高汽车在运行期间的稳定性，对现场的相关部分进行了一些改动。首先，在前轮的相关位置添加衬垫，以降低前轮的重心。其次，改变后轮轮轴上的调整块，提高后轮的重心，使车体向前倾斜一定程度，增加车辆的稳定性

4、。3.4后轮零件首先，更换后轮履带调整块，以增加两个后轮之间的距离这样，汽车转弯时不容易产生侧滑其次，调整后轮的速度差，使汽车转弯更灵敏。4.1电源部分需要调整电池电压以使智能车辆系统正常工作其中，单片机系统和车速传感器电路需要5V电压，光电传感器和途径识别接收电路工作在5V，伺服电机的工作电压范围为4.8V至6V(或由电池直接提供)。DC马达能够直接由7.2V2000mAh毫安时镍镉电池供电。考虑到驱动电机引起的瞬时电压降，采用低电压降的三端调压器是不可避免的。我们使用lm7805和lm7806作为牙齿稳定芯片。经测试，电压纹波小，完全知足要求。电池(7.2v)2000毫安镍镉1第三届全国大

5、学生智能汽车竞赛单片机对管5V调压器电路6V转速表转向器7.2V电机图4.1系统电压调节图图4.2799驱动电路如图4.4所示为了提高驱动能力，降低单片机的热输出，该电路采用了两片MC33886并联的方案。该系统利用脉宽调制控制电机转速，充分利用单片机的脉宽调制模块资源。电机脉宽调制频率设置为8千赫。MC33886芯片工作电压为5-40V，导通电阻为140毫欧，脉宽调制频率小于10KHz，具有短路保护、欠压保护、过热保护等功能。电机驱动芯片安装在制造的电机驱动印刷电路板上。在设计印刷电路板时，考虑到芯片散热的问题，在芯片的腹部设计了一个方形的通孔。实际运行结果表明，芯片散热均匀，设计合理。为了

6、防止电机忽然停止时的电磁干扰，在电机两端焊接了一个0.1F的滤波电容。r15res21kpwm3pwM5VCC31913182019101112u3in1in2D2D1dncagndpgndpgndpgndmc33886out1out1out2out2out2dncv+V+V+ccpfs67141584516172c12cap47PFR4res21.3CP1421header2r10+7.2v13SW-spdts22res21kr5res21kds2led2u533在程序中，我们直接将脉宽调制值转换为绝对速度，单位为米/秒，这使得智能车的速度愈加直观，易于调试。4.3测速电路考虑到成本，我们采

7、用红外灯管和黑白码盘作为测速模块的硬件组件码盘是一个32单元的黑白盘，如下列图所示:图4.5码盘的红外传感器安装在码盘的前面。固然精度远低于编码器，但成本低，易于制造。假如智能车速度快，它能够考虑减少码盘上黑白条纹的数量。当圆盘随齿轮转动时，光电池接收的反射光强度交替变化，进而获得一系列高低电脉冲。设置9S12的电容层析成像模块，同时收集光电池输出电脉冲的4上升沿和下降沿。通过在某个时间段内累计脉冲数或记录相邻脉冲之间的间隔时间，能够获得与速度相等的参数值。测速电路采用自行研制的红外反射式光电测速传感器。测速电路由红外反射光电对管RPR220、自制编码盘、比拟电路等组成速度测量电路图见2.8红

8、外反射光电对管的光电晶体管信号经比拟器处理后输入单片机的计数模块，利用单片机的输入捕捉功能处理智能车的速度信息自制的编码盘有24个黑色条纹，当电机旋转一次时会产生24个输入捕获中断。微控制器记录两次中断之间的时间间隔t对应于智能车辆的两个中断之间的距离S为16.5/24厘米，即0.6875厘米，其中16.5厘米是智能能源车辆7的后轮的测量周长智能车实时速度V(厘米/秒)的计算公式如下:伏？圣？16.5/24T？0.6875TCM/s30033krpr220328a14lm3585.1kioc0VCC10kVCC5.1k图4.6速度测量电路4.4红外线管对准检测电路由于我们使用高功率管对准，红外

9、线管对准电路是整个电路中要求最高的，确保管对准的正常运行并不重要，但也要考虑能耗和加热经过测试，我们发现当单对管子被提供100毫安到170毫安的电流时，它能够确保距离为20至30厘米此时，每对管道的管道压降为1.2至1.5伏为了进一步增加发光量，我们采用了双发光管的方法，即一个接收管对应两个发光管。为了降低整体能耗我们有同一对串联的发射管和14对并联的发射管。同时，irf540用于开关控制。控制管的脉冲发光开关频率为200赫兹这不仅保证了对大型前瞻性检测的需要，还降低了整体能耗和对电源的影响5第三届全国大学生智能汽车大赛图4.7脉冲发光二极管先串联后并联的电路图图4.8对面图4.9对面4年5月

10、，dip开关电路在智能车比赛开场后无法修改智能车的硬件和软件。在确保有效和可靠的硬件的同时，软件可能无法适应新的站点。因而，有必要设计倾角开关来设置智能车的相关参数。DIP开关电路如下列图所示:6R1表头9123456789VCCSW7SW6SW54SW34SW2SW1SW012345678SW-DIP8S161151413121109图4.9dip开关这是一个八段dip开关。我们把它分成上下两部分。显然，每个部分有16个状态。前四个改变转向器参数，后四个改变DC电机参数。这对适应新网站非常有好处。5.1途径搜索算法对于该控制系统，采用了14对光电管对的方案，在车身头部10厘米处排成一排编号为

11、6和7的光伏管位于正中心位置。使用14个传感器的道路识别传感器对白色的反射率大于对黑色的反射率。单芯片模数转换器的读入值相应较大。传感器信号在程序中被处理，以判定传感器能否检测到黑色引导线将白色和黑色道路的单个传感器的ADC值之间的差分成两个相等的部分，并且每次处理实时传感器信号时，判定采样ADC值和黑色道路的ADC值之间的差属于两个部分中的哪个部分假如接近黑色部分，则确定传感器检测到黑线，并且对应于传感器的变量被设置为确定值1；假如接近白色部分，则确定传感器检测到白线，并且对应于传感器的变量被设置为确定值1；为了提高判定的准确性，采用中值滤波方法消除采样模数转换器值时的瞬时干扰。在检测到途径

12、之后，测量的途径值被临时存储，然后途径信息被传输到转向机和马达控制部分，以选择给定的适宜的旋转角度和速度。7第三届全国大学生智能汽车竞赛5.2舵机、电机控制智能汽车舵机和电机采用经典的PID控制方法然而，由于转向机和马达的不同性能要求，已经分别进行了不同的修改。PID控制器由比例单元(P)、积分单元(I)和微分单元(D)组成输入e(t)和输出u(t)之间的关系是。积分的上下限分别为0和t，因而其传递函数为:g(s)=u(s)/e(s)=kp(1+1/(ti*s)+TD*s)，其中KP为比例系数；TI是积分时间常数；TD是用于控制电流的差分时间常数比率KP，误差值乘以负常数p(代表比率)，然后加

13、到预定值只要当控制器的输出与系统误差成正比时，p才成立。KP能够快速跟踪变化量。及时产生相关监管效果然而，KP有差动调节，不能消除静态误差。集成了KI来控制过去。误差值是一段时间内误差的总和，然后乘以负常数I，然后加到预定值上我从过去的平均误差值中找出系统输出结果和预定值之间的平均误差简单的比例系统在一个预定值附近来回振荡和变化，由于该系统不能消除多余的校正。通过添加一个负的平均误差比值，平均系统误差值将总是减小。因而，最终这个PID回路系统将被设置在预定值差分KD用于控制将来。计算误差的一阶导数，乘以负常数D，最后加到预定值上。对这种衍生物的控制将对系统的变化作出反响。导数结果越大，控制系统

14、对输出结果的响应越快。这个D参数也是为什么PID是一个可预测的控制器。d参数非常有助于减少控制器的短期变化。在第三届全国大学生智能汽车大赛中，一些速度为8、速度为的实际系统可能不需要D参数舵机PID由于舵机是一个大延时的执行器，PID控制中不能增加积分环节否则，汽车会振动。所以这辆车是由警察控制的同时，增加了一阶惯性环节，构成不完全微分，给汽车一个提早调整的时机。在的实际使用中，为了减少计算时间，将位置式PID转换成增量式PID公式:电机PID控制小车的运行经过，不同的速度值需要与不同的跑道相匹配，所以电机的PID是一个给定值不断变化的PID汽车的目的速度(目的速度)如下所示:1“汽车在直线轨

15、道上，目的速度的最大值为200。2汽车在大弯道上，物体速度为1603汽车是在小曲线或S形曲线上。物体速度为1204英寸，汽车冲出跑道，物体速度为705汽车从直道进入弯道，物体速度逐步降低99第三届全国大学生智能车大赛6“汽车从弯道进入直道，Object_Speed逐步提高在实验中发现，PID的超调主要在第一个波形中起作用，即当单速从很大到很小时，或者当单速从低速忽然加到高速时，会有很大的超调。然而，这种过冲不是有害的，由于当速度要求忽然改变时，通常是汽车从直道进入弯道或者从弯道进入直道的经过。这个经过通常需要非常快的加速和减速。由于汽车的惯性，常规的PID调节难以知足要求。这时，使用大的过冲能

16、够使汽车有一个加速或制动的经过，以更好地到达所需的速度。6.1Codewarrior开发环境在整个开发和调试经过中，使用了Metrowerks专门为MC9S12系列提供的一整套开发工具(FreescaleCodewarriorIDE4.6)。这是一套用C语言编程的集成开发环境智能车辆定位系统的软件设计部分就是在这个开发环境中完成的。Codewarrior是一款软件工具，专门为Metrowerks公司提供的飞思卡尔的所有微控制器和数字信号处理器嵌入式应用开发。这些包括集成开发环境、处理器专家、全芯片模拟、可视化参数显示工具、项目工程管理、穿插编译器、汇编器、链接器和调试器。CodeWarrOsi

17、de能够自动检查您的代码能否有明显的错误。它通过集成的调试器和编辑器扫描您的代码，以发现并减少明显的错误，然后编译并链接程序，以便计算机能够理解并执行您的程序。每个应用程序都要经过编码、编译、编辑、链接和调试的经过，使用的开发工具有CodeWorrior。MetrowerksCodewarriorIDE中的mc9s12dg128.h文件为对应于所有寄存器的存储映射地址定义了宏。开发人员能够在软件开发经过中直接调用这些宏。6.2软件模拟以便更好地定量分析影响汽车行驶的各种因素，并最大限度地节约时间和成本10第三届全国大学生智能汽车竞赛我们采用了软件仿真和实际调试相结合的方法。模拟软件使用清华大学

18、的PLAST2通过仿真，我们发现:1，汽车传感器的检测距离对车速有决定性的影响。因而，传感器应尽可能探测。然而，传感器的检测距离不能超过最小转弯半径。否则会有盲点。2，适当增加转向器的灵敏度能够使转向愈加灵敏。因而，在的实际调试中，我们加长了舵机力臂。在6.2和的实际调试经过中，我们发现汽车在直路上会左右摇摆。通过软件设置死区或其他处理方法，效果不明显。最后，我们发现方向盘和汽车前轮之间的间隙是罪魁祸首。通过将前轮设置成内八角形，这个问题得到了完美的解决。在的调试经过中，我们增加了液晶显示器和蜂鸣器。比赛期间不需要这些辅助设备来减轻汽车的重量。但在调试经过中，通过这些设备，我们能够及时了解汽车

19、的运行情况，到达事半功倍的效果。11表7.1第三届全国大学生智能车竞赛模型车技术参数统计表项目参数途径检测方法(竞赛题目组)光电组模型几何尺寸(长、宽、高度(mm)车型轴距/轨道距离(mm)车型平均电流(匀速)(毫安)电路总电容(微加工)传感器类型和数量385*220*60200/150200430红外线管15新增加的伺服电机0轨道信息检测空间精度(mm)9轨道信息检测频率(次/秒)200主要集成电路类型/数量9s12微控制器最小系统/112第三届全国大学生智能汽车竞赛33886电机驱动电路/4速度检测电路/1模块重量(带电池)(kg)0.9参考1黄凯生，金华民，蒋南南，韩国智能模型车技术方案

20、分析，北京:清华大学汽车安全与节能国家重点实验室，2004.3256北京:清华大学出版社，2004.23)（LM2940数据手册），2000年7月，国家半导体公司4)（LM7806数据手册）国家半导体公司5)（RPR220数据手册），罗门6)（半导体技术数据手册）MC338872002年8月摩托罗拉公司7)（大型赛车模具装配手册）8CodeWarriorIDE3.1帮助数据手册2002年8月摩托罗拉公司13第三届全国大学生智能汽车大赛13（12科16b8v1数据表），2002年7月摩托罗拉公司141516:/doczj/doc/99064625091c59eef8c75fbfc77da2692

21、5c59623.html程序电机PID控制程序259typedef无符号字符INT8U。typedef带符号charINT8Stypedef无符号intINT16Utypedef带符号intINT16Stypedef无符号长INT32U。typedef带符号长INT32Stypedef浮点FP32typedef双FP6414/无符号8位数/有符号8位数/无符号16位数/有符号16位数/无符号32位数/有符号32位数/单精度浮点数/双精度浮点数#defineMAX_32(有符号长)0x7fffffl#defineMIN_32(有符号长)0x8000000001#define有符号整数比例。有符号

22、intIntegralGain带符号intIntegralGainScale有符号的int衍生词。带符号的int派生类。带符号intPositivePIDLimit带符号整数负数极限；有符号intIntegralPortionK_1；带符号intInputErrok_1；sCaiXinBoPIDsCaiXinBoPIDSpdPIDexternsignedintCaixinBopidController(signedintDesiredValue，signedintMeasuredValue，ScaixinBopid*pParams)；静态签名长L_sub(寄存器签名长src_dst，寄存器签名

23、长src2)15第三届全国大学生智能汽车竞赛静态签名长L_deposit_l(寄存器签名长ssrc)静态签名intextract_l(寄存器签名长lsrc)静态签名长L_multreturn(签名长)(ssrc)。return(签名int)lsrc。注册签名长laccumlaccum=sinp1laccum*=sinp2。返回laccumreturn(src_dst+src2)。第三届全国大学生智能车大赛符号整数积分控制器(符号整数期望值，符号整数测量值，ScaixinOpid*PParams)符号长比例比例比例比例，积分比例，积分输出；签名的int输入恐惧；必须设置/*-*/*饱和形式*/*

24、输入恐惧=sub(所需值，测量值)；*/*输入误差*/*-*/*输入误差计算-16位范围，有和无饱和形式*/PidOutput=L_sub(L_deposit_L(DesiredValue)，L_deposit_L(MeasuredValue)；/*输入错误-32位范围*/假如(PIDoutputMAX_16)/*输入错误大于0x00007fff=32767-32位范围*/输入错误=MAX_16/*输入误差=最大值。正16位有符号值*/elseif(PidOutputInputError=MIN_16；/*输入误差=最小值。负16位有符号值*/else输入恐惧=提取_l(PidOutput)；

25、/*输入误差-16位范围*/*-*/17第三届全国大学生智能汽车竞赛/*比例计算*/比例比例=l_mult(p参数-比例增益)，输入误差)(p参数-比例代数+1)；/*-*/*积分部分计算*/积分部分=L_mult(pParams-IntegralGain)，输入恐惧)(pParams-IntegralGainScale+1)；/*步骤k中的积分部分+步骤k-1中的积分部分*/积分部分=L_add(积分部分，L_存款_l(pParams-积分部分k_1)；/*整数部分限制*/if(IntegralPortion)(pParams-positivepidLimit)(pParams-Integr

26、alPortionK_1)=(pParams-positivepidLimit)；elseif(integralportonnegativePidLimit)pParams-IntegralPortionK_1=pParams-negatepidelimit；elsepParams-IntegralPortionK_1=extract_l(IntegralPortion)；/*-*/*导数部分计算*/PidOutput=L_sub(L_deposit_L(输入恐惧)，L_deposit_l(pParams-输入恐惧_1)；/*e(k)-e(k-1)/*e(k-1)=e(k)*/假如(PidOu

27、tputMAX_16)/*e(k)-e(k-1)大于0x00007fff=32767-32位范围*/InputError=MAX_16；/*e(k)-e(k-1)=最大。正16位有符号值-16位范围*/elseif(PidOutputDeriveGain)，InputError)(pParams-DeriveGaInScale+1)；/*-*/*控制器输出计算*/PidOutput=L_add(PidOutput，比例分配比例)；/*导数部分+比例部分*/PidOutput=L_add(PidOutput，L_deposit_L(PParams-IntegralportionK_1)；/*+积

28、分部分=控制器输出*/*控制器输出限制*/if(PidOutputPParams-positivePidLimit)PidOutput=PParams-positivePidLimit；ELSEIF(PidOutDownePideLimit)193届全国大学生智能车竞赛PID输出=参数-负极性EpidLimit；，初始值void_init(void)/*设置rti中断频率*/*调整为1毫秒(1.024ms),16MhZ振荡器*/RTIL=0x1f；/5*216:48.8赫兹/0x1f/setrtiprescaler:晶振16384分频；(低四位+1)*(2(高三位+9)CRGINT=0x80；

29、/使能RTI中断；/低四位:1-7，不能为0，否则分频器不起作用空隙集_锁相环(空隙)CLKSEL=0x00；PLLCTL=0xe1。0；/转换队列长度8，非先进先出存储形式，ATD0CTL4=0x85/8bus_clk/(2*(5+1)位精度，AD时钟为ATD0CTL5=0x90；/右对齐，无符号数，单转换队列形式，第1通道开场，6通道；多通道8通道，ATD1CTL2=0xc0，从通道0开场；/ADPU，快速标志去除ATD1CTL3=0x30；/序列长度:6，非fifo形式，ATD1CTL4=0x85/8时钟:bus_clk/(2*(5+1)bitdecision，ATDATD0CTL5=0

30、x90；/右对齐，无符号数，单转换队列形式，第1通道开场，6通道；多通道8路，从通道0开场，/*ATD初始化程序*/Vortuservio_init(Void)/转向机16位脉宽调制控制PWME_PWME1=0；/禁用PWM1伺服PWMPRCLK|=0x03/clka:除以8PWMCLK|=0x00。/这是默认值/通道1使用时钟源/24兆赫兹/8=3兆脉宽调制POL_PPOL1=1/第一高电平PWMce=0x00；21/默以为左对齐第三届全国大学生智能车竞赛PWMCTL_CON01=1；/通道1:16位连接PWMPER01=30000；/30000:10ms；30，000/舵机周期为10ms1

31、/3M*x=1/100/1ms脉冲至2ms脉冲/1.5ms脉冲对应0度PWMDTY01=4500；/4500:1.5毫秒；/控制3500左极限5500右极限4500正中心PWMCNT01=0；/写入计数寄存器将使能PWMDTYx、PWMPERx进入锁存器，并从该值PWME_PWME1=1使能通道；/脉宽调制通道1输出/*致动器初始化程序*/voidforward_init(void)/假设正向。初始化功能/PWM3:in1/PWM5:in2=1/PWM7:en/ddrp=0xff；/控制输出PWME_PWME3=0；PWME_PWME5=0；PWMPRCLK|=0x20；/时钟B总线频率除以4

32、/通道3使用时钟B时钟源/24MHz/4=6M脉宽调制POL_PPOL5=0；/低电平第一，、高电平第一，但高电平制造者mc33886禁用22第三届全国大学生智能车竞赛pwMCE/对齐默认左对齐PWMCTL_CON45=1；/16位连接PWMPER45=750/电机频率8khz1/1.5m*x=1/2khzPWMDTY45=500；/占空比精度1/750PWMnt45=0；PWME_PWME5=1；/脉宽调制通道3输出/*电机初始化程序*/voidECT_Init(void)/ECT初始化，使用输入捕捉功能TSCR1_TFFCA=1；/自动去除标志TSCR2=0x87/定时器溢出中断打开，TC

33、NTPrescaler:24兆赫兹/128=187.5千赫兹计数频率TIOS_0=0；/相应的通道充当输入捕获/开CH0PT0；TCTL4_EDG0A=1；/仅在通道0的上升沿捕获TCTL4_EDG0B=0；TIE_C0I=1；/使能Ch1中断TSCR1_TEN=1；/ENABLETIMER主程序#include/*commondefinitions和宏*/#include/*derivativeinformation*/23/启动脉宽调制第三届全国大学生智能汽车竞赛#Pragmalink_infoderivative#include#DefineAD_LEVEL130#DefineMID47

34、85#DefineMAXTURN750#DefineDC_Limit/停车变量charzanshi=0；/速度调节传感器=4785；/转向器中间重量3=0，0，0；整数0=0；国际反倾销值14；intI；国际ATD_value14；charboma=0；/dip开关intzhidao_speed=0；intwangdao_speed=0；int冲初_速度=0；/速度设置intcha0，cha1/不完全微分24第三届全国大学生智能汽车大赛易失无符号整数0计数器=0；易失性无符号intIC0COunter_1=0；易失性无符号intstop_flag=0；不稳定的瞬时速度；/2.083毫秒一个in

35、t易失性无符号intGearWidth4=0；易失性无符号intGearIndex=0；无符号长齿轮宽度总和；无符号长AveGearWidth无符号长AveSpeed/速度测量无符号intpulse_counter=0；/计数intDCDutyint对象_速度=速度；/100cm/sintstop_stop=0xff，stop_stop1=0；/*转动PID功能*/intpid1(inta，intb，intc)intx=0；x=(KP1*(a-b)+KI1*a+KD1*(a-2*b+c)；返回(x)；/*/作废主文件(作废)SPDPID。比例增益=30000；/1.520.150.050.94

36、1.8424903SpDPid。比例缩放比例=13；(0-1):增益等级=14/0.76is25第三届全国大学生智能汽车竞赛/(0-2):增益等级=130-1280-256./(0-4)0-80-160-320-64/.0-32768-不能取最后一个数字，能够有十进制数。随着数字的增加，小数字减少，从15到0/精度1/32768-1SPD工艺管道仪表流程图。积分增益=25000；/20480；150001.45(pianda)0.925SpDPid。IntegralGainScale=14/14；/系数spdpid.导数增益0.6250.450.150.85=20000；/0SpdPID。派生

37、规模=14；SpdPID。正皮迪极限=DC极限；SpdPID。负上限=0；SpdPID。IntegralPortionK_1=0；/=0SpdPID。inputErrok_1=0；/=0RTI_Init()；锁相环()；ATD_Init()；伺服_初始化()；forward_Init()；ECT_Init()；DDRT=0x00；boma=PTIT；/读入倾角开关；boma=4；boma261.25第三届全国大学生智能车大赛zhidao_speed=90+7*boma；wangdao_speed=75+4*boma；冲初速度=50；/60+boma；启用中断；用于(；)/if(ABS(ave_weight2)