大学队技术分析方案Final_第1页
大学队技术分析方案Final_第2页
大学队技术分析方案Final_第3页
大学队技术分析方案Final_第4页
大学队技术分析方案Final_第5页
已阅读5页,还剩66页未读, 继续免费阅读

付费下载

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

1、第一届“飞思卡尔”杯全国大学生智能汽车邀请赛技术报告附件 B 智能移动小车的开发与研制学校:四川大学队伍名称:四川大学1 队参赛队员:杨承凯、钟鹏、陈果带队教师:杨刚I/70II/70关于技术报告和研究论文使用授权的说明本人完全了解第一届“飞思卡尔”杯全国大学生智能汽车邀请赛关保留、使用技术报告和研究论文的规定,即:参赛作品著作权归参赛者本人,比赛组委会和飞思卡尔半导体公司可以在相关主页上收录并公开参赛作品的设计方案、技术报告以及参赛模型车的视频、图像资料,并将相关内容编纂收录在组委会出版论文集中。参赛队员签名:杨承凯钟鹏陈果带队教师签名:杨刚日期: 2006-8-5I/70目录第一章前言 3

2、第二章模型车设计制作的主要思路以及实现的技术方案概要说明 2 2.1 检测机构 2普通红外对管 3带调制红外传感器3图像传感器 32.2控制算法 3第三章模型车机械部分安装及改造、传感器的设计安装、系统电路板的固定及连接等 43.1机械改动及电路板安装43.2线阵 CCD图像传感器的设计53.3速度检测传感器 8第四章电路设计说明8第五章 HS12 控制软件主要理论、算法说明及代码设计介绍等 10 5.1 模糊控制器的基本结构 11模糊集合的隶属函数12论域 12模糊推理 12第六章开发工具、制作、安装、调试过程说明 20 第七章模型车的主要技术参数说明 21结论 22II/70参考文献 23

3、附录 A :源代码 XXIV附录 B:智能移动小车的开发与研制XXVII第一章 前言本智能车采用了红外光电开关作为速度检测单元,线阵CCD图像传感器作为引导线检测单元,模糊控制作为主要控制算法。红外光电开关发出的红外线受安装在驱动电机转轴上的扇页片切割,通过其两次跳变信号的时间间隔即可计算出车轮转速; CCD的驱动信号由外部独立数字电路产生,输出信号由放大比较电路处理后将空间上引导线的位置映射为时间上相应时刻的脉冲信号,MCU只需要向 CCD发出帧同步信号然后检测输出脉冲发生的时间便可以判断出引导线的位置,软件消耗极小;模糊控制器以 CCD视觉中心偏离引导线的误差和误差变化率作为输入量,以舵机

4、转向角作为输出量,输入隶属函数采用三角形法,输出隶属函数采用脉冲法,由人的驾驶经验和智能车实际运行情况得到模糊规则,采用 MAX-MIN推理法则得到输出语言,通过重心法计算出转向角。报告的第一部分介绍模型车设计制作的主要思路以及实现的技术方案;第二部分介绍模型车的机械改装、电路板固定和传感器的设计;第三部分介绍模型车主控板的电路设计说明;第四部分介绍模糊控制的主要理论、算法说明和代码设计介绍;第五部分介绍开发工具、制作、安装、调试过程说明;第六部分介绍模型车的主要技术参数;III / 70第七部分是对设计的总结。第二章 模型车设计制作的主要思路以及实现的技术方案概要说明智能车是一个集光、机、电

5、于一体的综合性系统,主要包括执行机构、检测机构和控制器,系统结构如图 2.1 。执行机构由大赛统一规定,本设计未做任何改装,现主要考虑的是检测机构和控制算法。图 2.12.1 检测机构检测白色背景上黑线的方法很多,主要分为普通红外对管,带调制红外传2/70感器, CCD图像检测等。普通红外对管普通红外对管使用简单、反应快、信号稳定、灵敏度好,在智能车前方安装一排这种对管可以较好的检测到地面上的引导线,但其检测距离近,一般有效距离为 5mm-20mm,不能探测到前方赛道信息,在小车高速时通过这种方式检测到赛道变化再做出反应一般来不及,很容易冲出赛道,本设计中没有采用此方案。带调制红外传感器普通红

6、外对管经过调制 调制频率一般为 40K)后可以探测到更远的距离,但要求反射面垂直,智能车检测赛道时射线是倾斜反射的,探测距离大打折扣,不过仍然能达到 30cm 左右,本设计曾采用过此方案,实测中发现调制后不同对管之间容易产生干扰,若采用时分方式总体采样率又太低,故放弃了此方案。图像传感器CCD图像传感器分为线阵和面阵两种,由于智能小车只需要检测黑线的位置,可以不需要面信息,选用了线阵CCD比较合适。 CCD图像传感器优点在于可以稳定的检测到较远距离的赛道信息一般在 30cm以上),并且检测分辨率高,帧采样频率也较高 和 12V 电源条件下。在使用 PD3575D设计线阵 CCD图像传感器的过程

7、中有两个难点。一是驱动信号的产生,二是输出信号的处理。PD3575D的驱动需要四路脉冲 ,分别为转移栅时钟 IO、复位时钟 RO、采样保持时钟 SHO和传输门时钟 TG,它们的时序图如下:5/70图 3.2在明确了 CCD的驱动时序后,下面关心的便是如何产生这四路驱动信号。有两种方案:错误 ! 由单片机程序产生四路时钟驱动信号,这种办法简单易行。但实际上是不适用于智能小车系统的。因为驱动信号的频率相当高8M),如果用单片机产生这个信号,那几乎将占用所有的单片机时间,导致无法对信号做出处理和响应其他操作。错误 ! 由外围电路直接产生CCD驱动时钟,这种办法比较复杂,要用计数器和触发器专门设计一个

8、时序电路因为大赛规定另外不能用可编程器件),单片机只需要产生一个帧同步信号 模糊控制不依赖于被控对象的精确数学模型,仅依赖专家知识和操作者的经验。2 模糊控制具有较强的知识表达能力,可以将专家知识和操作者经验以规则的形式加以描述和提炼。3模糊控制具有较强的推理功能,经过模糊推理可以实现类似与人的决策过程。5.1 模糊控制器的基本结构图 5.1 为基本模糊控制系统,其中 T 为采样周期; r 为设定值; y 为被控过程的输出; e* ,ec* 和 u* 分别为偏差、偏差变化率、控制增量的精确量;A*、B*和 C*分别为 e* , ec* 和 u* 的模糊量; qe 、 qec 和 qu 分别为

9、e* , ec* 和 u* 的量化因子和比例因子。u*quu 被r(kTe*(kT模模糊糊 C*晰控+ec*B*推过化化-理qu程+qece*(kT-T输入输出隶属函数T图 5.1模糊控制器基本结构模糊集合的隶属函数在人类的思维中,有许多模糊的概念,如大、小、冷、热等,都没有明确的内涵和外延。只能用模糊集合来描述;有的概念具有清晰的内涵和外延,如男人和女人。我们把前者叫做模糊集合,后者叫做普通集合 或经典集合)。如果把模糊集合的特征函数称为隶属函数。记作A (x) ,则A ( x) 表示元素属于模糊集合A 的程度。隶属函数是模糊数学中最基本的概念,我们用隶属函数来给出模糊集合:在论域U 上的模

10、糊集合A ,由隶属函数A (x) 来表征,A ( x) 区间内连续取值。 A ( x) 的大小反映了元素 x 对于模糊集合 A 的隶属程度。论域所谓论域,即隶属函数输入量的的变化范围,一般分为离散论域和连续论域。离散论域即是说输入量的变化的离散的,不连续的,比如我们常说的年龄,通常是按整数来表示的,从 0 岁到 120 岁,那么它就是一个离散论域;连续论域即是说输入量的变化是连续的,如温度,从 -30到 80。模糊推理模糊逻辑主要研究模糊推理,模糊推理实际上是从模糊前提出发按照模糊规则进行推理,而后得出结论 也是模糊的)。模糊规则是模糊推理的依据,这些12/70模糊规则是人们实际工作中的经验用

11、语言的表达,因此也称为语言规则,基本上采用如下三种形式 16 。错误 !“如 A 则 B 型”。此种形式可以写成“ IF A THEN B”的条件语句,例如:“如果土壤干燥则洒水”。错误 !“如 A 则 B 否则 C”型。此种形式可以写成“ IF A THEN B ELSE C ”,例如:“如果土壤干燥则洒水,否则就不洒水”。错误 !“如 A 且 B 则 C”型。此种形式可以写成“ IF A AND B THEN C”,例如:“如果土壤干且气温高,则洒水”。以上几种模糊规则中,第三种用得最多,尤其是在模糊控制中更是如此。因为在控制过程中,不但要考虑实测值与设定值之间所形成的误差,而且还要考虑这

12、个误差的变化率,一般用A 表示误差, B 表示误差变化率, C 表示控制量。输出清晰化模糊推理的结果依然是模糊量,这种结论不能用来控制,因为系统依然不知道控制量到底是多少。因此,必须进行反模糊化,将模糊控制量变为精确控制量。反模糊的输入是前一步模糊规则的输出,即输出变量各语言值的隶属度,反模糊化的输出是系统输出变量的精确输出值。其过程就是根据输出变量的隶属函数,从输出变量各语言值的隶属度求出精确的输出值的过程。也就是说,反模糊化的过程是在输出变量隶属度函数的图形中,已知 Y 值求 X 值的过程。这一过程需要用户提供的数据是输出变量的隶属函数。反模糊化有多种方法,最常用的是最大隶属度法和重心法。

13、错误 !最大隶属度法最大隶属度法用于要求不高的系统,它是选取输出语言值中隶属度最大者作为最终语言值。该语言值变化范围的中心值就作为实际输出的精确值。错误 !重心法在要求较高的系统,反模糊一般采用重心法 COG),即求所有模糊输出量的重心,计算公式如下:13/70nSi FiCOGi 15-2)nFii 1这里, Fi 代表的就是输出变量的隶属度,Si 代表输出变量的语言值。5.2 控制器设计本系统中,利用模糊控制器来控制智能移动小车的运动轨迹,首先需要得到控制器的输入量。上文中我们得出,在不打滑时,移动智能小车的运动轨迹与车速无关,只与前后轮距离和小车转向角度有关。根据这一结论,要使移动智能小

14、车能够正确的寻迹,需要调整的只是转向角 前后轮距离是已知量),所以,传感器检测的重点也是转向角误差,考虑到当转向角误差相同时,不同的误差变化率可以反映出不同的轨道半径,因此,本设计中还检测了转向角误差变化率。通过 CCD 图象传感器来检测白色地面上的黑线,根据返回的信号便可以得出驾驶角误差和误差变化率,如图 4.8:e引导线t2t1传感器检测区域图 5.2引导线检测原理图检测出 t1,t2 间的误差 e,然后根据上一次误差计算误差变化率 ec,由此得到控制器的误差输入量。14/70当误差量 e 很小,且误差不变时,就可判定为智能小车正沿着引导线行驶,则机器人小车沿直线行进;若误差变化率比较大时

15、,表明智能小车正在偏离引导线,此时,就需要对航向角做出相应的调整。前文已经给出移动智能小车的运动学模型和传感器的输入特征,需要指出的是,通过 CCD 传感器得到的检测信号是其视觉中心与引导线中心的位置差,设计中控制的目标是让视觉中心与引导线中心重合。基于这个模型的模糊控制如下。模糊集与隶属函数将 CCD 图象传感器视觉中心的误差和误差变化率作为控制器的输入,以下用e和 ec表示,输出为驾驶角,用 表示,模糊语言值分别选为:e:LB ,LM , LS,CE,RS,RM , RBec: PB ,PM, PS,ZO,NS,NM ,NB:LB , LM ,LS, CE, RS, RM ,RB 隶属度函

16、数采用三角形,函数表达式如下式18 。(x a) /(ba), xa & x bF ( x)(x c) /(b c), x b & x c0, 其他LM LSCE RS RM RBLB-9-6-30369NBNMNSZO PSPMPB-9-6-30369LBLMLSCE RSRMRB-25-13-5051325误差 ecm)误差变化率ec得到约束条件 a2-bl=b2-cl。定义模糊集中心点之间的距离 D=b2-bl 。这样论域上的所有模糊集隶属度函数的参数就由交叠系数和 D 确定下来,在多次调节这两个参数就可以对系统最优化处理。模糊推理与模糊控制算法推理的方法很多,本设计使用的是最常见 MA

17、X-MIN 法则,这种方法的推理过程大致如下:错误 !建立规则库基于驾驶经验可以得到下表所示的模糊规则表:表 5.1模糊规则表ec eLBLMLSCERSRMRBNBRbRbrmrmrsceceNMRbRbrmrmrsceceNSRbRbrmrscelmlmZORbRbrscelslblbPSRmrmcelslmlblbPMCeCelslmlmlblbPBCeCelslmlmlblb错误 !寻找对推理起作用的规则。一般情况下,一个输入变量的精确输入值对应于该变量各语言值的隶属函数只有一个或两个非零值。那么,双变量输入的系统中就会有 1 条、 2 条、 3 条或 4 条规则有效。其他规则对推理不

18、起作用。在本设计中,如果 e=5 且 ec=-2,经过模糊化后,它们各具有两个非零的隶属度。这样,就共有 4 条规则有效。16/70错误 !确定规则强度。所谓规则强度,就是有效规则成立的“真实”程度,或则说有效规则的“适合度”、“力度”。实质上就是规则后件中输出模糊变量某语言值的隶属度。根据 MAX-MIN法则,由于规则前件间用“AND ”操作符连接,因此,每一条规则的强度等于前件中的最小值,同时,规则后件用“ OR”操作符连接,因此,每一条规则的强度等于后件中的最大值。输出清晰化因为移动智能小车系统对控制要求比较高,所以反模糊采用的是重心法。由输出隶属函数可以看出,设计中使用的是脉冲法,这样

19、运算比较简单,而且实践证明可三角形法的效果相比基本没有性能上的下降。例如,当推理机的输出为 RS(0.5和 RM(0.3 时,反模糊化结果为 0.55+0.313)/0.3+0.5)=8度。5.3 软件实现要实现模糊控制程序,首先要构造模糊语言集、隶属函数和推理矩阵,程序中构造如下:/误差论域enum ERRORlb,lm,ls,ce,rs,rm,rb。/误差变化率论域enum DFERRORnb,nm,ns,zo,ps,pm,pb 。/驾驶角输出论域enum OREAdlb,dlm,dls,dce,drs,drm,drb。/隶属函数参数结构struct TRIANGLE_ int a。 in

20、t b。 int c 。 TRIANGLE。/ERROR 隶属结构typedef struct FUNCERROR_ enum ERROR key。 TRIANGLE func 。 FUNCERROR 。17/70/DFERROR 隶属结构typedef struct FUNCDFERROR_ enum DFERROR key。 TRIANGLE func 。 FUNCDFERROR 。/OREA 隶属结构typedef struct FUNCOREA_ enum OREA key。 char func 。 FUNCOREA 。/ERROR 变量结构typedef struct VARIERR

21、OR_ enum ERROR key。 float dat 。 float sub 。 V ARIERROR 。/DFERROR 变量结构typedefstructVARIDFERROR_enumDFERRORkey 。floatdat 。floatsub 。 VARIDFERROR 。/OREA 变量结构typedef struct VARIOREA_ enum OREA key。 float dat 。 float sub 。 V ARIOREA模糊控制程序流程如下:18/70开始读取CCD视觉误差ccd_error.dati=0; buff_error.len=0;ccd_error.d

22、at处于func_errori.func.a与func_errori.func.c之间?Y计算隶属度 subYccd_error.key=func_errori.key;ccd_error.sub=sub;Nbuff_error.arr_errorbuff_error.len=ccd_error;buff_error.len+;i+;i7?N读取CCD视觉误差变化率ccd_dferror.dati=0; buff_dferror.len=0;i=0; j=0;n=0;buff_orea.len=0;sub=minbuff_error.arr_errori.sub,buff_dferror.ar

23、r_dferrorj.sub;key=rulebuff_error.arr_errori.keybuff_dferror.arr_dferrorj.key;nbuff_orea.len?n+;YYNNbuff_orea.arr_orean.key=key?Ybuff_orea.arr_orean.subsub?Ybuff_orea.arr_orean.sub=sub;Buff_orea.arr_orean.key=key;Buff_orea.arr_orean.sub=sub;buff_orea.len+;j+;jbuff_dferror.len?ccd_dferror.dat处于func_d

24、ferrori.func.a与func_dferrori.func.c之间?YNi+; ibuff_error.len?Y计算隶属度 subYccd_dferror.key=func_dferrori.key;ccd_dferror.sub=sub;Nbuff_dferror.arr_dferrorbuff_dferror.len=ccd_error;buff_dferror.len+;i+;i7?n=0; result_orea=0; sum=0;func=func_oreabuff_orea.arr_orean.key.func;Ysub=buff_orea.arr_orean.sub;r

25、esult_orea+=funcsubsum+=sub;n=+; nbuff_orea.len?result_orea/=sum;返回图 5.4寻迹控制程序流程图19/70第六章 开发工具、制作、安装、调试过程说明软件开发工具使用 codewarrior4.1, 程序下载调试工具使用大赛组委会统一的清华 BDM for S12 调试器。模型车安装好后主要调整差速器的松紧和前轮的前束,之后主要是熟悉 S12 平台的开发,包括编译器和调试器的使用。平台熟悉后就开始写单片机各模块的驱动程序,遇到问题时主要是通过看编译器帮助文档、芯片 datasheet 或上网询问等办法解决。为了避免智能车在调试过程

26、中突然冲出跑道冲撞其它物体造成车体损坏,临时加入无线开关控制其启动和停止。在赛车运动状态下,主要的调试方法是把想要了解的参数写到单片的 E2PROM 里,然后再从串口读出以查看参数值。对于一些智能车非运动条件下的参数,可以直接通过串口查看。测试赛道选择韩国 2004 赛道 检测频率100HZ21/70结论根据智能移动小车的特点和设计目标,采取了模糊控制算法对小车的寻迹进行控制,实践中控制器发挥了相当不错的效果,智能小车在弯、直道上均能快速转向并很快达到稳定,寻迹速度约为 1.4m/s 。所设计的 CCD图象传感器系统,与 MCU接口简单,占用极小的 MCU软件资源,使用方便可靠,在应用实际应用

27、中发挥出了良好的性能。使用了红外光电开关检测车轮的转速,性能稳定可靠。不足和尚需完善之处:在智能移动小车走小的 S 型弯道可以想办法让小车不转弯直线行驶过去,因为比赛时智能小车可以跑两圈,打算在第一圈记录一些统计信息,第二圈时根据上一圈的统计信息识别出前方 S 型弯道,通过让参考点偏移的方法使小车直线通过。22/70参考文献蒋新松 . 机器人学导论 . 第一版 . 沈阳:辽宁人民出版社 .1994 : 420-426吴广玉、姜复兴 . 机器人工程导论 . 第一版 . 哈尔滨:哈尔滨工业大学出版社1988: 196-2413徐国华,谭民. 移动机器人的发展现状及其趋势. 机器人技术与应用,200

28、1 年第三期: 5-16 页周远清、张再兴 . 智能机器人系统 . 第一版 . 北京:清华大学出版社, 1989: 24-27张吉礼 . 模糊 - 神经网络控制原理与工程应用 . 第二版 . 哈尔滨:哈尔滨工业大学出版社, 2004: 19-21西三一郎 . 自律型机器人制作 . 第一版 . 北京:科学出版社, 2001: 89-94张岩、胡秀芳等 . 传感器应用技术 . 第一版 . 福建:福建科学技术出版社,2005 :24-28王国鼎、袁海庆、陈开利. 桥梁检测与加固 . 第一版 . 北京:人民交通出版社,2003: 16-179 邵贝贝 .单片机嵌入式应用的在线开发.第一版 .北京:清华

29、大学出版社,2004: 40-4223/70附录 A:源代码/*Copyright(c*四川大学*-文件信息 -文 件 名: datatype.h创 建 人:陈果最后修改日期 : 2006 年 4 月 14 日描述: 重新定义数据类型以方便编程*-历史版本信息 -创建人 : 陈果版 本: 1.0日 期:2006年 4月 14日描 述: 原始版本*-当前版本修订 -修改人 :日 期 :描 述 :*-* */#ifndef _DATATYPE_H#define _DATATYPE_Htypedef unsigned char uint8 。typedef signed char int8 。typ

30、edef unsigned int uint16 。typedef signed int int16 。typedef unsigned long uint32 。typedef signed long int32 。typedef float fp32 。typedef double fp64 。24/70typedef structuint8 nCounter 。uint16 arrLine5 。LINE_INFO 。extern LINE_INFO gLineInfo。extern LINE_INFO lLineInfo。extern uint8 ctrFlag 。 extern int

31、32 fRev 。/extern fp32 fAcc 。extern uint8 CpFlag 。extern uint8 gAngle 。#endif#include datatype.hLINE_INFO gLineInfo。LINE_INFO lLineInfo。uint8 ctrFlag=1 。uint8 CpFlag=0 。int32 fRev=0 。/fp32 fAcc=0 。uint8 gAngle = 90 。/*Copyright(c*四川大学*-文件信息 -文 件 名: UART.h创 建 人:陈果最后修改日期 : 2006 年 4 月 15 日描述: UATRT 头文件

32、,只提供发送功能用于程序调试*-历史版本信息 -创建人 : 陈果II/70版 本: 1.0日 期:2006年 4月 15日描 述: 原始版本*-当前版本修订 -修改人 :日 期 :描 述 :*-* */#ifndef _UART_H#define _UART_H#include #include datatype.h#include /#define BaudRate9600/#define BusClock24000000void UART_Ini(void。void UART_SendChar(unsigned char b 。voidUART_SendStr(char *p 。#prag

33、ma CODE_SEG _NEAR_SEG NON_BANKEDvoid interrupt Isr_RecUART(void。#pragma CODE_SEG DEFAULT#endif#include datatype.hIII / 70#include motorcontrol.h#include timer.h#include pwm.h#define MAXACC 100#define KVOT1#define KP 6#define KI 10#define MAXDIVU 5int32 CurRev 。int32 CurAcc 。 int32 PreErrAcc 。 int32

34、VisualVot 。 /fRev /fAccvoid SetRev(int32 refRevint32 RefAcc 。int32 ErrRev 。int32 ErrAcc 。int32 ErrVot 。int32 OutV ot。CurRev = fRev 。/ CurAcc = fAcc 。ErrRev = refRev - CurRev 。RefAcc = ErrRev * 1000 。if(RefAccMAXACC RefAcc = MAXACC。ErrAcc = RefAcc - CurAcc。ErrVot = 80*ErrAcc - 78*PreErrAcc。ErrVot /=

35、100 。VisualVot += ErrV ot。OutVot = VisualV ot / KVOT 。/*if(OutVot = 0elseOutVot = -OutVot 。*/if(OutV ot = 255 OutV ot = 255。if(OutV ot OutV ot = 0 。IV/70PWMDTY2 = OutV ot。PreErrAcc = ErrAcc 。void PISetRev(uint32 refRevstatic int32 preerror=0 。static int32 sumu=0 。int32 divu 。int32 error 。error = ref

36、Rev - fRev 。divu = KP*(error - preerror + KI*error。divu /= 60 。if(divuMAXDIVUdivu = MAXDIVU。if(divudivu = -MAXDIVU。sumu += divu 。if(sumu255sumu = 255 。if(sumusumu = 0 。PWMDTY2 = sumu 。preerror = error 。V/70#ifndef _MOTORCONTROL_H#define _MOTORCONTROL_Hvoid SetRev(int32 refRev 。void PISetRev(uint32 r

37、efRev 。#endif#include pwm.hvoid PWM_Ini(void/DDRA = 0X0F 。 /PORTA_BIT0 = 0 。/PORTA_BIT1 = 1 。DDRB = 0XFF 。PORTB = 0X20 。DDRA = 0XF0 。PORTA_BIT5 = 1 。PWME=0。PWMPOL = 0Xfb 。PWMCAE = 0 。PWMCTL = 0X10 。PWMCLK = 0X07。PWMSCLA = 133 。PWMSCLB = 5 。/PWMPER0 = 0X07 。/PWMPER1 = 0X08 。PWMPER0 = 0X03 。PWMPER1 =

38、0X86 。PWMPER2 = 0XFF 。PWMDTY0 = 0 。PWMDTY1 = 148 。PWMDTY2 = 0 。PWME = 0X07 。VI/70void SteeringgearAngle (unsigned char aif(a = 180 a = 180 。if(a a = 0 。PWMDTY1 = 58 + a 。void MotoSpeed(unsigned char sunsigned char nTemp。nTemp = PWMDTY2 。if (s PWMDTY2 = s 。 elsewhile(nTempPWMDTY2 = nTemp 。nTemp+ 。PWM

39、DTY2 = nTemp 。/PWMDTY2 = s 。#ifndef _PWM_H#define _PWM_H#include void PWM_Ini(void。void SteeringgearAngle (unsigned char a 。VII / 70void MotoSpeed(unsigned char s 。#endif/*Copyright(c*四川大学*-文件信息 -文 件 名: timer.c创 建 人:陈果最后修改日期 : 2006 年 4 月 15 日描述: timer 主文件*-历史版本信息 -创建人 : 陈果版 本: 1.0日 期:2006年 4月 15日描 述

40、: 原始版本*-当前版本修订 -修改人 :日 期 :描 述 :*-*/#include timer.h#define TG PORTK_BIT0#define Pulse_EN PORTK_BIT1#define _8us asm ( nop 。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。nop。 nop。 nop。 nop 。 nop 。 nop 。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。nop。 nop。 nop。 nop 。 nop 。 nop 。 nop。 nop。 nop。 nop。 no

41、p。 nop。 nop。 nop。nop。 nop 。 nop。 nop。 nop 。 nop。 nop 。 nop。 nop 。 nop。 nop 。 nop。 nop 。 nop。VIII / 70nop。 nop。 nop。 nop 。 nop 。 nop 。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。nop。 nop。 nop。 nop 。 nop 。 nop 。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。nop。 nop 。 nop。 nop。 nop 。 nop。 nop 。 nop。 nop 。 nop。 n

42、op 。 nop。 nop 。 nop。nop。 nop。 nop。 nop 。 nop 。 nop 。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。nop。 nop。 nop。 nop 。 nop 。 nop 。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。nop。 nop。 nop。 。#define _1us asm ( nop 。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。nop。 nop。 nop。 nop 。 nop 。 nop 。 nop。 nop。 nop

43、。 nop。 nop。 nop。 nop。 nop。nop。 nop。 nop。 nop 。 nop 。 nop 。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 nop。 #define MAXPULSEWIDTH 1200#define MINPULSEWIDTH 100uint32 nOFCounter = 0 。uint32 nRevPeriod=0 。/uint16 cnt 。/char str20 。void Timer_Ini(voidMCCTL = 0Xc6 。 MC

44、CNT = 30000 。/TSCR2_PR = 3 。TSCR2_TOI = 0 。TSCR1_TFFCA = 1 。TCTL4_EDG0A = 1 。TCTL4_EDG0B = 0 。TCTL4_EDG1A = 0 。TCTL4_EDG1B = 1 。TCTL4_EDG2A = 1 。TCTL4_EDG2B = 0 。TIE = 0X03 。TSCR1_TEN = 1 。/IX/70DDRK = 0X03 。TG=1。Pulse_EN = 0 。/EnableInterrupts 。 void GetRev(voidstatic int32 arrPreRev8 。/static fp32

45、 fPreRev 。static uint8 nRevCounter=0 。/fp32 nRevTemp 。/nRevTemp = (nRevPeriod=0?0:(750000/nRevPeriod。arrPreRevnRevCounter = nRevPeriod 。nRevCounter+ 。if(nRevCounter = 8nRevCounter = 0 。fRev = (arrPreRev0+arrPreRev1+arrPreRev2+arrPreRev3+arrPreRev4+arrPreRev5+arrPreRe v6+arrPreRev7/8 。fRev /= 100 。 /

46、fAcc = fRev - fPreRev 。/fPreRev = fRev 。#pragma CODE_SEG _NEAR_SEG NON_BANKEDvoid interrupt Isr_Timer(void/static uint16 counter=0 。uint16 temp 。X/70/TIE = 0X01 。 /MCFLG_MCZF = 1。 temp = MCCNT 。Pulse_EN = 0 。TG = 0 。 _8usTG = 1 。 _1usPulse_EN = 1 。/gLineInfo = lLineInfo。lLineInfo.nCounter = 0 。ctrFl

47、ag = 1 。nOFCounter+ 。void interrupt Isr_IC0(voidstatic uint32 nPreOFCounter = 0 。static uint16 nPreTC0 = 0 。uint32 nPeriod 。uint16 nTemp 。nTemp = TC0 。 nTemp = MCCNT 。nPeriod = (nOFCounter - nPreOFCounter*0X7530 + nPreTC0 - nTemp 。 if(nPeriod nRevPeriod = nPeriod 。 nPreOFCounter = nOFCounter 。nPreTC

48、0 = nTemp 。CpFlag = 1 。GetRev( 。XI/70void interrupt Isr_IC1(voiduint16 nTemp 。nTemp = TC1 。lLineInfo.arrLinelLineInfo.nCounter = MCCNT。 /cnt = MCCNT 。nTemp = TC2 。 TIE |= 0X04 。void interrupt Isr_IC2(voiduint16 nTemp 。nTemp = TC2 。nTemp = MCCNT 。nTemp = lLineInfo.arrLinelLineInfo.nCounter - nTemp。/s

49、printf(str,%u=%u=%u,nTemp,lLineInfo.arrLinelLineInfo.nCounter-1,lLineInfo.nCounter 。/UART_SendStr(str 。if(nTempMINPULSEWIDTH&(nTempif(lLineInfo.nCounterlLineInfo.nCounter+ 。TIE &= 0XFB 。 nTemp = TC1 。#pragma CODE_SEG DEFAULT/*Copyright(c*四川大学*-文件信息 -文 件 名: timer.h创 建 人:陈果最后修改日期 : 2006 年 4 月 15 日描述:

50、timer 头文件*-历史版本信息 -XII / 70创建人 : 陈果版 本: 1.0日 期:2006年 4月 15日描 述: 原始版本*-当前版本修订 -修改人 :日 期 :描 述 :*-*/#ifndef _TIMER_H #define _TIMER_H#include #include datatype.h#include #include #include uart.hvoid Timer_Ini(void。void GetRev(void 。#pragma CODE_SEG _NEAR_SEG NON_BANKEDvoid interrupt Isr_Timer(void。void

51、 interrupt Isr_IC0(void。void interrupt Isr_IC1(void。void interrupt Isr_IC2(void。XIII / 70#pragma CODE_SEG DEFAULT#endif/*Copyright(c*四川大学*-文件信息 -文 件 名: UART.c创 建 人:陈果最后修改日期 : 2006 年 4 月 16 日描述: UATRT 主文件 ,只提供发送功能用于程序调试*-历史版本信息 -创建人 : 陈果版 本: 1.0日 期:2006年 4月 15日描 述: 原始版本*-当前版本修订 -修改人 :日 期 :描 述 :*-*/#i

52、nclude UART.hvoid UART_Ini(voidSCI0BD = 13 。 / 设置波特率寄存器SCI0CR2_TE = 1 。 /使能发送SCI0CR2_RE = 1 。 / 使能接收/SCI0CR2_RIE = 1 。/ 接收中断使能EnableInterrupts 。XIV / 70void UART_SendChar(unsigned char bwhile(SCI0SR1_TDRE=0 。SCI0DRL = b 。voidUART_SendStr(char *pwhile(*p!=0UART_SendChar(*p+ 。#pragma CODE_SEG _NEAR_SE

53、G NON_BANKEDvoid interrupt Isr_RecUART(voiduint8 nTemp 。SCI0SR1_RDRF = 0 。nTemp = SCI0DRL 。PORTB = nTemp 。#pragma CODE_SEG DEFAULT#include /* common defines and macros */#include /* derivative information */#include datatype.h#include timer.h#include uart.h#include pwm.h#include motorcontrol.h#inclu

54、de fuzzy.h#include e2prom.h#include XV/70/#include rtsxgate.cxgate#pragma LINK_INFO DERIVATIVE mc9s12dg128b/extern uint32 nOFCounter 。extern int32 nRevPeriod 。/float nRev 。/extern uint16 cnt 。uint8 brake=0 。void main(void/start your code here/char str40 。/ uint8 i 。int16 temp 。uint16 rev=0 。/uint8 b

55、rake=0 。Timer_Ini( 。UART_Ini( 。PWM_Ini( 。E2PROM_Ini( 。/PORTB = 0X00 。while(PORTA_BIT0=0。 /MotoSpeed(160 。while(1if(PORTA_BIT1=1MotoSpeed(0 。brake = 1 。/WriteE2PROM(rev,0 。else if(PORTA_BIT0=1 brake = 0 。XVI / 70else if(ctrFlag = 1 /wait foreverif(CpFlag!=1fRev = 0 。fAcc = 0 。else CpFlag = 0 。/if(bra

56、ke=0/MotoSpeed(250 。/sprintf(str,%lu%ld ,fRev,fAcc。/ UART_SendStr( 。/for(i=0 。 i/sprintf(str,%u ,gLineInfo.arrLinei。/ UART_SendStr(str 。/ctrFlag = 0 。/gAngle = 90 + (int8FuzzyControl(。temp = (int16FuzzyControl(。gAngle = 90 + (int8temp 。SteeringgearAngle(gAngle 。/*Copyright(c*四川大学XVII / 70*-文件信息 -文 件

57、 名: E2PROM.h创 建 人:陈果最后修改日期 : 2006 年 4 月 17 日描述: E2PROM 头文件*-历史版本信息 -创建人 : 陈果版 本: 1.0日 期:2006年 4月 17日描 述: 原始版本*-当前版本修订 -修改人 :日 期 :描 述 :*-* */#ifndef _E2PROM_H#define _E2PROM_H#include #include datatype.h#include void E2PROM_Ini(void。voidWriteE2PROM(uint16 data,uint16 addr。uint16 ReadE2PROM(uint16 add

58、r。#endif/fuzzy.c#include datatype.hXVIII / 70#include #include #include UART.h#include e2prom.h#include pwm.h/*/micro defines#defineKEX0.007936#defineKECX 300/#defineKECX 200/#defineCEX13234#defineCEX123.6/*/*/micro defines/#defineKEX 8/#defineKECX 0.001/#defineCEX300/*enum ERRORlb,lm,ls,ce,rs,rm,rb

59、。enum DFERRORnb,nm,ns,zo,ps,pm,pb 。enum OREAdlb,dlm,dls,dce,drs,drm,drb。typedef struct int8 a 。 int8 b 。 int8 c。 TRIANGLE。typedef struct FUNCERROR_ enum ERROR key。 TRIANGLE func 。 FUNCERROR 。typedef struct FUNCDFERROR_ enum DFERROR key 。 TRIANGLE func 。 FUNCDFERROR 。typedef struct FUNCOREA_ enum ORE

60、A key。 char func 。 FUNCOREA 。typedef struct VARIERROR_ enum ERROR key。 fp32 dat 。 fp32 sub。 VARIERROR 。XIX / 70fp32 ex = 0.00000001 。fp32 pre_ex = 0.0000001 。 fp32 ecx = 0.0000001 。FUNCERROR func_error7 = lb,-100,-9,-6, lm,-9,-6,-5, ls,-6,-5,-3, ce,-5,0,5,typedef struct VARIOREA_ enum OREA keytypede

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论