《第十一届“恩智浦”杯全国大学生智能汽车竞赛电磁组技术报告.docx》由会员分享，可在线阅读，更多相关《第十一届“恩智浦”杯全国大学生智能汽车竞赛电磁组技术报告.docx（52页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、第十一届“恩智浦”杯全国大学生智能汽车竞赛电磁组技术报告学 校：南昌大学队伍名称：不倒的土豆参赛队员：王梦华晁睿杰汪佳宇指导老师：杨晓辉朱自伟第十一届“恩智浦”杯全国大学生智能汽车竞赛电磁组技术报告学 校:队伍名称:参赛队员:屎,3 1 1费拘椀朱指导老师:关于技术报告和研究论文使用授权的说明本人完全了解第十届“恩智浦”杯全国大学生智能汽车竞赛关保留、使用 技术报告和研究论文的规定，即：参赛作品著作权归参赛者本人，比赛组委会 和恩智浦半导体公司可以在相关主页上收录并公开参赛作品的设计方案、技术 报告以及参赛模型车的视频、图像资料，并将相关内容编纂收录在组委会出版 论文集中。参赛队员签字：王梦华
2、晁睿杰汪佳宇指导老师签字：杨晓辉朱自伟日期： 2016年8月10日关于技术报告和研究论文使用授权的说明本人完全了解第I届“恩科浦”杯全国大学生智能汽车竞赛关保留、使用 技术报告和研究论文的规定，即：参赛作品著作权归参赛片本人，比赛组委会 和恩智浦半导体公司可以在相关I页上收录并公开参赛作品的设计方案、技术 报告以及参赛模型车的视频、图像资料，并将相关内容编纂收录在组委会出版 论文集中。参赛队员签字：L学*鱼族区丘守指导老师签字：局或掷朱自强_日 期：_引5日第一章概述及设计思路1.1 概述1.2 整车设计思路1.2.1 控制系统1.2. 2整车布局1.2.3电磁组的主要特点第二章硬件设计2.1
3、硬件系统总体设计ft.海取可简美12 32. 2传感器方案2. 2.1磁场检测传感器2. 2. 2赛道检测传感器布局2. 3主板电路设计2.4姿态模块传感器2.4. 1陀螺仪加速计第三章软件设计3. 1原理分析1 .1.1车模平衡控制3 . 1.3车模方向控制第四章机械4. 1制作情况概述4. 2系统机械方案选定4.3车模的机械结构4. 3.1车模的机械结构4. 3. 2电感支架4. 3. 3陀螺仪加速计的安装4. 3. 4齿轮咬合与车胎处理第五章系统的开发环境与车模的调试5.1 开发环境5.2 上位机软件第六章车模的主要参数6.1 智能汽车外形参数6.2 智能汽车技术参数附件11 主程序：参
4、考文献第一章引言1.1 概述“恩智浦”杯全国大学生智能汽车竞速竞赛，前身是“飞思卡尔”智能汽 车竞速竞赛，今年进行到第十一届，几年经验的积累使得比赛形式丰富，比赛 规则比较完善，为广大同学提供了一个良好的学习提高的平台。第十一届大赛， 延续往年第七届的规则，电磁车为直立行走模式，以100mA的交变电流为赛道, 自主开发检测传感器，检测赛道信息。为响应教育部关于加强大学生的创新意识、合作精神和创新能力的培养的 号召，我们组队积极参加了第十一届“恩智浦”杯全国大学生智能汽车电磁组 的比赛。从20115年11月开始着手进行准备，历时近10个月，鉴于电磁组 与光电、摄像头在检测方法上有本质的不同，我们
5、在传感器设计上采用电感线 圈检测磁场，通过在多个点布置不同方向的检测传感器获取赛道信息，利用所 获取的信号进行处理，实现对赛车转向、速度进行控制。同时，我们利用前几届比赛积累下的经验，继续加强在电源管理、噪声抑 制、驱动优化、整车布局等方面的研究工作，使智能车能够满足高速运行下的 动力性和稳定性需求，获得了良好的综合性能和赛场表现。本技术报告将针对我们的传感器信号处理设计安装、底盘参数选择、电路 设计、控制软件主要理论、控制算法等方面进行阐述，并列出了模型车的主要 技术参数。1.2 整车设计思路1.2.1 控制系统智能车的工作模式：电磁传感器获取赛道某点电磁特性，信号输入到k60 控制核心进行
6、进一步处理以获得赛道信息；通过旋转编码器转速传器检测车速;第十一届全国大学生智能汽车竞赛技术报告电机转速控制采用PI控制，通过PWM控制驱动电路调整电机的功率。1.2.2 整车布局鉴于赛车和赛道的特点，并且车模特性，今年在整车布局上仍延续基本布 局的思路，采用低重心紧凑型设计。为调整整车重心位置，采用碳杆支撑电磁 传感器，减小转动惯量。在降低整车重心方面采用了低位的布局，同时设计了强度高质量轻的电磁 传感器安装架，减轻信号采集电路板重量。图1-1图1-21.2.3 电磁组的主要特点1、传感器信号为模拟值电磁组需要检测的信号为大小lOOMa,频率为20KHz的方波信号，赛道有 大仙铺成，导线周围
7、分步着交流变化的磁场，由于赛道的各种形状，使得磁场 发生叠加，不同的赛道形状不同的特征磁场，如下图为十字赴京的磁场。赛道 信息相对于传统黑白线具有信号可以提供模拟信息的优势，我们利用电磁赛道 这种优势，完善小车控制算法，达到了较好的控制效果。图1-32、传感器信号具有方向性磁场是矢量，在空间的分布为具有方向性，所以传感器检测到的信号也具 有特定的方向性。在实际检测的时候发现，不同方向传感器的变化规律有很大 的不同，这也和磁场的分量变化规律相一致。比如，磁场垂直分量变化的比较 早，但是受相邻赛道的影响较大，而磁场的水平分量恰好相反。第二章硬件设计2.1 硬件系统总体设计2.1.1 可靠可靠是系统
8、设计的第一要求，我们对电路设计的所有环节都进行了如下的 改进和设计：电源系统的稳压性能、纹波噪声的去处、功率的充足提供的可靠性等； 主控系统的电路优化，减少电路元件的体积和用量，减少不稳定因素；动力系 统的动力性能可靠性，如加速、制动等性能会有大幅度的改善，为整车的性能 提升提供充足的保证；做好各部分的接地、屏蔽、滤波等工作，将高速数字电 路与模拟电路分开，使本系统工作的可靠性达到了设计要求；传感器的性能稳 定，保证整车数据流的准确可靠；2.1.2 简洁为了尽量减轻整车重量，降低模型车的重心位置，应使电路设计尽量简 洁，尽量减少元器件使用数量，缩小电路板面积，使电路部分重量轻，易于安 装。我们
9、在对智能车系统进行分析后可以通过以下几点来进行对系统简洁处理:智能车机械结构的简化，这需要我们设计出更加精巧、灵活的机械构件， 提高智能车的精度，提高智能车的制作工艺，简化智能车的机械复杂程度。在 对智能车硬件电路系统进行了详细分析后，通过认真筛选所用器件、简化电路、 合理设计元件排列、电路走线，最终的硬件电路板采用贴片封装形式，使本系 统硬件电路部分轻量化和机械强度部分的指标达到设计要求。2.1.3 美观一个好的设计应该是能给人以美感的。除了满足基本的设计要求之外， 我们还对元器件的摆放位置做了大量的尝试，使得整个电路较为美观。图2-1电路板3D图2. 2传感器方案2. 2.1磁场检测传感器
10、使用10mH电感和6. 8nF电容并联谐振，来感应20KHz的磁场信号，经 放大电路放大后，得到正弦波，再用AD采样，得到正弦波的峰值，以判断传 感器离导线的距离，从而定位导线。由于官方给出的三极管放大电路不易调节 放大倍数，检波电路信号变化速度较慢，我们决定使用运放放大直接由AD采样。电路图如下。运放使用了 TL082双运放，能够将信号放大几千倍，可以满 足探测的需要。图2-2磁场检测传感器电路图2. 2. 2赛道检测传感器布局电磁传感器测出的信号为当前所在位置的某个方向的磁场信息，所以传感 器的布局至关重要。通过实验发现，当传感器相距较大，视角宽，得到的赛道 信息量大。所以，采用尽量架宽主
11、要传感器的方式，以获得丰富的赛道信息， 并且提前预知赛道形状。2. 3主板电路设计2. 3.1电源模块电机是直接接电池，编码器5v,磁感采集模块5V,单片机系统是3. 3v。这里我们使用了 TPS7350和TPS7333两种稳压芯片。UI0S05封装LI-t 15V.TO.3JVloouii 干 =C4lOuF I MMAGND 5V FOR 3.3V5v转3JV电源惑采集7_2V电源MOTORSOUT3D OUT4DAGND3.3V电源电机电源系统板OLED等r-MoloxA(iND5V电源电机244 0码国董牙电源模块图2-3主板电源2. 3. 2驱动模块电机驱动使用BTS796E BTS
12、7961为集成MOS驱动，其外部电路接线简单,性能稳定。图2-4 BTS7961驱动原理图2. 3. 3最小系统我们为了节约成本，使用了自我制作的最小系统。MCU JVJC5C3二二二二MKMDMI2ZVLLI0MCU JVJPHO mi rn2 mu FTM FTES PTF* VDO VSS USMO_DP usmCdm voufu VREC3N ADC_nPI ADCO DMI ADCI DPI AIXI DMI aixCdtj ADC I 二 DM， ADC二DM ado-m图3-3运动车模平衡为了使运动的车模保持平衡，可以通过建立车模的运动学和动力学数学模 型，设计反馈控制来保证车模
13、的平衡。为了使得同学们能够比较清楚理解其中 的物理过程。下面通过对比单摆模型来说明保持车模平衡的控制规律。单摆模型分。车模底部可以 运动的倒 立单摆图3-4车模简化成倒立的单摆3.1.2 车模速度控制对于直立车模速度的控制相对于普通车模的速度控制则比较复杂。由于在 速度控制过程中需要始终保持车模的平衡，因此车模速度控制不能够直接通过 改变电机转速来实现。下面先分析一下引起车模速度变化的原因。假设车模在 上面直立控制调节下已经能够保持平衡了，但是由于安装误差，传感器实际测 量的角度与车模角度有偏差，因此车模实际不是保持与地面垂直，而是存在一 个倾角。在重力的作用下，车模就会朝倾斜的方向加速前进。
14、图2-2显示了这 个关系。控制速度只要通过控制车模的倾角就可以实现了。3.1.3 车模方向控制实现车模方向控制是保证车模沿着竞赛道路比赛的关键。直立车模所在的 电磁组的道路中心线铺设有一根漆包线，里面通有100mA的20kHz交变电流。 因此在道路中心线周围产生一个交变磁场。通过道路电磁中心线偏差检测与电 机差动控制实现方向控制，从而进一步保证车模在赛道上。1、道路电磁中心线的偏差检测道路电磁中心线检测简单的方法可以通过安装在车模前方的两个电磁感应线圈实现。线圈一般采用10mh的工型电感。4MMs应纨国 lOmHx 2 工字型电感图3-5检测赛道中心电磁线方式2、电机差动控制利用电磁线偏差检测
15、信号分别与车模速度控制信号进行加和减，形成左右轮 差动控制电压，使得车模左右轮运行角速度不一致进而控制车模方向。3,方向控制算法方向控制算法根据车模检测到电磁感应电压来生成电机差动控制量。通 过左右电机速度差驱动车模转向消除车模距离道路中心的偏差。通过调整车 模的方向，再加上车前行运动，可以逐步消除车模距离中心线的距离差别。 这个过程是一个积分过程，因此车模差动控制一般只需要进行简单的比例控 制就可以完成车模方向控制。但是由于车模本身安装有电池等比较重的物体, 具有很大的转动惯量，在调整过程中会出现车模转向过冲现象，如果不加以 抑制，会使得车模冲出赛道。根据前面角度和速度控制的经验，为了消除车
16、模方向控制中的过冲，需要增加微分控制。微分控制就是根据车模方向的变化率对电机差动控制量进行修正的控 制方式，因此需要增加车模的转动速度检测传感器。可以使用陀螺仪传感器 进行检测。由于电磁导引线的磁场强度与检测线圈的距离和方向都有关系。当车模 的方向偏差很大的时，比如在车模前方出现急转弯的时候，检测线圈中轴线 与电磁导引线不再垂直，出现一个很大的角度偏差。此时两个检测线圈的感 应电动势都下降。为了更能准确反映车模重心距离电磁线缆的距离差别，避免角度的影像, 在进行方向控制时，使用左右两个线圈感应电动势之差除以左右两个线圈感 应电动势之和，使用该比值进行方向控制。这样可以消除检测线圈角度的影 响。
17、第四章机械4.1制作情况概述根据第十一届智能汽车竞赛的规则，本组选用比赛方提供的E型车模，采 用飞思卡尔32位微控制器K60作为核心控制单元，自主设计主控制板和其他 相应的功能模块电路，磁感采集的赛道信息和加速度及、陀螺仪融合的姿态信 息完成对小车的直立控制、速度控制以及转向控制，从而小车的自主循迹和对 不同赛道环境的适应。本组着重研究了两轮平衡小车直立原理，分析了车体机械结构对小车性能 的影响，根据规则对车模进行了合理的改造，选择比较轻便、稳固的机械结构。 深入理解PID参数在小车控制中所发挥的作用，通过不断调试优化各个参数， 对弯道、直角、单线等赛道元素选择合适的处理策略，以增强小车的适应
18、性与 稳定性。通过对小车系统的整体方案、机械结构、硬件设计、软件算法等方面的实 践，阐述了本组在智能车制作中的方法与思路。在将近一年的时间里，小组成 员查阅了大量资料，学习了通信、自动化、计算机、机械等多个学科的知识， 培养了我们电路设计、软件编程、系统调试等方面的能力，以系统的角度看待 问题，锻炼了我们知识融合、实践动手并付诸创新的能力，对今后的学习工作 都有着重大的实际意义。4. 2系统机械方案选定为了满足比赛要求，需采用比赛规定范围内芯片，单一电源供电，实现平 衡车，本组采用了如图所示的小车系统结构。线性CCD用于采集赛道信息，可 以将传感器采集到的亮度信息转换为电压值；光电编码盘用于测
19、量小车行进的 距离，根据行进的时间转化为小车当前速度；MPU3050是三轴陀螺仪，而MMA8451 是加速度计，通过融合加速度与角速度可以控制小车直立。这些传感器采集的 数据通过12c总线传输到K60中进行处理后，微控制器将直立控制量、速度控 制量以及转向控制量一并加在电机上，控制小车完成相应操作。单片机通过蓝 牙与上位机进行串口通信，方便检查系统故障和调试参数，根据比赛规则要求，系统还设计有灯塔接收检测模块，用于发车以及停车，整个系统由竞赛提供的 标准银铭电池作为供电模块。TSL1401线性CCD光电编码盘MPU3050MMA8451图4T系统原理图分析了解车模的大体功能，选定最优的车模机械
20、安装方案。车模的机械结构在某种程度上限制着小车的最高速度，在速度较低的情况 下各种机械结构可能没有太大差别，当速度逐渐加快时，相同的控制算法在不 同的机械结构上就会有不同的表现。对模型车的机械结构有一个全面清晰的认 识尤为重要，先建立相应的数学模型，再针对具体的设计方案来调整赛车的机 械结构，并在实际的调试过程中不断的改进优化和提高结构的稳定性。本章内 容为E型车模的结构设计，电路板和各个传感器的安装。4. 3车模的机械结构4. 3.1车模的机械结构本组选用E型车模，其长度为255mm,宽度为155mm。相比之前的D 车模，E车模车轮距更大，在转向方面更有优势，且选用的电机型号为RS-380,
21、功率更大，没有了减速齿轮组，齿轮比更小，车轮转速更快，车 速提升空间更大。图4-2 E型车模对于平衡车来说，整个车子的重心高低十分重要。过高的重心会使车子在 转向的时候容易侧翻、抬轮子，容易产生系统的不稳定；对于速度控制，很小 的倾角就会产生较大的加速度，不利于精确地控制速度。但是车子的重心也不 能过低，首先过低的重心会使车子在过坡时车底碰到坡道，其次过低的重心不 利于车子迅速加速。车模上的两个电机位置不能改变，可以改变位置的结构只有电池和主板的 位置，电感支撑杆的长度不仅影响着前瞻，也对车体的平衡有很大影响。小组 在经过多次讨论与尝试后，采用了下图所示的机械结构，电池和电路板置于车 体之前，
22、使车子前倾时可以更快的达到设定速度，电磁支撑杆长约45cm,正常行进时前倾20度左右;截取车模尾部，这样做的好处是时车子转弯时更加灵活, 较小的控制量就可以完成转弯，可以平稳匀速的过弯，减轻跳轮的问题，但出 现的问题是稳定性变差，尤其是在以较快速度过坡道时，由于车体过于轻巧， 车子会脱离赛道，在空中的小车没有着力点而失控，为此在小车底部添加配重 来实现坡道的稳定。图4-3车体机械4. 3.2编码器的安装1厘米D轴标准2.54接口小车系统需要外部的速度反馈来完成控制，本组没有采用不易使用的 光电码盘，而是采用安装简便的mini编码器，这样的优点是可以让车体 更加轻便，动力损失小，同时测量精度能够
23、满足该设计，安装方便；缺点 是排线容易损坏。Mini编码器的原理与其他测速常用的编码器相同，也是 将检测到的遮光次数转化为脉冲信号从而实现速度检测。并做了适当的改 装和调节使得其便于安装、拆卸和维护17厘米输出排线图4-4 mini编码器参数图4-5编码器安装图4. 3.3电感支架为了尽量减轻伸出车体外支架的重量，本组选用碳纤维杆作为支架材料, 用热熔胶固定在支架上，底部通过与支架垂直的碳纤维杆加固支架，防止小车运行中支架的晃动对传感器采集造成影响。搭建这样的结构可以用很轻的质量 获得较好的稳定度，支架的刚度也有所保证，便于拆卸与维修。电磁杆的俯仰 角度影响小车的前瞻，角度低会使前瞻变变大，不
24、利于对赛道信息的预判，相 反则会使前瞻变小，但是也会带来误判等问题。图4-6电磁杆4. 3.4陀螺仪加速计的安装为了最大程度减少车模运行时振动对于测量倾角的干扰，将转向陀螺仪和 加速度传感器放在同一块电路板上，并且将此模块安装在车体上而非主板上， 这样传感器获得的数据才是车子自身的倾角信息，而主板会由于震动引入噪声。 整个模块安装应注意与车体运行时处于与水平垂直的位置，安装的位置一定要 正，尽量靠近中间，否则会使小车在转向时造成左右转向不均。图4-7陀螺仪加速计安装4. 3. 5齿轮咬合与车胎处理齿轮咬合要求传动流畅又不易打齿，使车子在行进时不会发出很大噪声， 否则会加大传感器的噪声，不利于小
25、车的控制。仔细调整塑料齿轮和铜齿的间 隙，经常涂用润滑油，及时清理齿轮间的异物，使得控制和提速更容易。在速 度较快的情况下，车胎的摩擦力是限制智能车速度提升的一个因素，对车胎进 行适当的打磨可以增强车胎的摩擦力，并且经常擦拭，小车过弯时不易打滑， 但过大的摩擦力也不利于车子流畅的转弯。第五章系统的开发环境与车模的调试5.1开发环境在对程序进行开发和软硬件联调的过程中需要一整套的软件开发与调试 工具。程序的开发是在IAR Embedded Workbench下进行的，包括源程序的编 写、编译和链接，并最终生成可执行文件。包括集成开发环境IDE、处理器专 家库、全芯片显示工具、项目工程管理器、C交
26、叉编译器、汇编器、链接器以 及调试器。| motor c IMPU6050C、t e -空 2 , -40K., 一* /MR JK B 30 n nI*t KTl 1 - l-M- 1300 )ZlO.Ottaq使用J-LINK来下载程序，把编译好的程序下载到单片机里运行Fte3 0 vcan_K，- - DZ1 向口|-ffl Bcwc kaBmc i- E) mem c-UDP0RT_c9 。口 Bod-BvCAN_ASOIc -BVCAN.K. fl”，0uii! ：飞”&：疗。*馥片tl M-JUUN.-4B B caicutabonc -ffl 0 Oelascopa c HB E
27、)Uuy_pdc a&ecc -bBljg4Wc -Bmcujc.ic图5T IAR开发环境5. 2上位机软件智能车调试的过程中上位机软件功不可没，一个好的上位机可以查看和修 改小车的各个参数，查看重要变量的曲线并且记录小车在行进过程中电感的图 像信息，并可以进行波形分析。我们使用datascope上位机。图5-2 datascope上位机界面第六章车模的主要参数6.1智能汽车外形参数经改装后，智能汽车的外形参数：车长：600mm；串宽：250mm；车重：1.0kg。6. 2智能汽车技术参数智能汽车相关技术参数如表项目参数车模轴距/轮距（毫米）200/140车模平均电流（匀速行驶）（毫安）30
28、00电路电容总量（微法）1500传感器种类及个数线性电感/3个，编码器2个，陀螺 仪一个，加速计一个，干簧管2个新增加伺服电机个数0赛道信息检测空间精度（毫米）5赛道信息检测频率（次/秒）100第十一届全国大学生智能汽车竞赛技术报告附件11 v主程序：#include “common, h”#include include, h”void main()车子参数(car. angle_set = 120; 设置车子姿态，平衡姿态car. angle min = 87. 7;car. angle max = 163. 4;car. direction d = 6;car. direction_p
29、= 200;)fittingO ;fitting_angle_error();car_init(); 功能初始化 MPU3050_Init();/ ;/ L3G4200_Init();/DELAY_MS(100);/ MMA8451_Init();DELAY_MS(1000);Gyroscope_self_inspection();陀螺仪上电自检,DELAY_MS(10);car_start ();while(l)OLED_display();/OLED_DISPLAY_Waiting();if( Datascope_out6 = 500)/gpio_turn(PTB16);LED_Count
30、er = 0;程序运行指示LED灯if( car. car_start_ready = 1 ) if( Start_Couter 20 ) Start_Couter+;if(LED_Counter%50 = 0) (gpioturn (PTA12);gpio_turn (PTB16); )/Comp_filter();互补滤波motor_set ();电机控制switch(PITCounter) (case 1:break;case 2: break;case 3:break;case 4:第十一届全国大学生智能汽车竞赛技术报告 break;case 5:Gyroscope_Get();/MM
31、A8451_XYZ();/L3G4200_XYZ();Kalman_filter ();卡尔曼滤波blance_control ();平衡控制getAD_Result();读取 AD 值 direction_control ();方向控制motor.DirectionControlPeriod = 0 ; break; case 6: break; case 7:break;case 8: speed_control ();motor. g_nSpeedControlPeriod = 0 ;速度分配计数清零break;case 9: make_speed_equal();motor. left
32、_right_equalPeriod = 0;break;Gyroscope_Get () ;/3050 数据读取MMA8451_XYZ();/ L3G4200_XYZ();卡尔曼滤波平衡控制Kalman_filter(); blance_control ();PIT_Counter = 0; break;)default: break;IIlliif(car. car_startequally = 4 ) (car. speed_start = 1;if(car. car_startequally = car. angle_max)(car. protect_flag = 1;if ( ca
33、r. ramp_flag = 1 )检测到坡道if ( car. speed pulse counter =12000)坡道累计脉冲car. ramp_flag = 0;坡道标志清除，距离下一次坡道检测是1500mscar. ramp up flag = 0;/car. ramp_down_flag = 0;/car. ramp interval time = 1500;)car. ramp counter flag = 0;/if( car. ramp interval time 一个坡道检测多次一(car. ramp i nterval t ime;!= 0 )控制坡道检测时间,清中断标志
34、位写1清中断标志位PIT_Flag_Clear(PITO);uint8 tiao = 0;void PORTA_IRQHandler()uint8 n = 0;引脚号n = 13;if(PORTA_ISFR & (1 n)(PORTA_ISFR = (1 n); if( PTA13_IN = 0 )第十一届全国大学生智能汽车竞赛技术报告DELAY_MS(10);if( PTA13_IN = 0 )/blance_p+;if(tiao = 0)l：car. blance angle -=0.2;)elsecar. direction p -=10;)/car. direction d -=1;w
35、hile( PTA13_IN = 0 );/gpio_turn(PTC4);)/ printf (n 按下按键n);)n = 14;if(PORTA_ISFR & (1 n)(PORTA_ISFR = (1 n); 写1清中断标志位if( PTA14 IN = 0 )DELAY MS(10);if( PTA14_IN = 0 )(/blancep;/car. direction p -=10;if(tiao = 0)fcar. blance angle +=0. 2;/tiao = 1;) else /tiao = 0;)while( PTA14 IN = 0 );)/gp i o_t urn
36、(PTC4);)/ printf (n按下按键下“);)n = 15;if(PORTA_ISFR & (1 n) (PORTA_ISFR = (1 n);写1清中断标志位if( PTA15_IN = 0 )DELAY_MS(10); if(tiao = 0)car. blance angle += 0. 5; else (car. direction p +=10;while( PTA15_IN = 0 );)/ printf (n 按下按键n);n = 16;if(PORTA_ISFR & (1 n) PORTA_ISFR = (1 n); 写1清中断标志位 if( PTA16_IN = 0
37、 ) DELAY_MS(10);if( PTA16_IN = 0 )car. car start ready = 1;车子准备完成标志car. protect_flag = 0;car. stop flag = 0;/blance_d-;/gpio_turn(PTC4);while( PTA16_IN = 0 );/printf Cn 按下按键n);void PORTC_IRQHandler()Iuint8 n = 0; 引脚号n = 13;if(PORTC_ISFR & (1 n) PORTC_ISFR = (1 n); 写1清中断标志位 if( PTC13_IN = 0 ) if( PTC13_IN = 0 ) (car. stop_flag = 1;gpioturn (PTB16);/printf (n 按下 A13 按键n);参考文献1 .邵贝贝.嵌入式实时操作系统LC/OS-H （第2版）M.北京.清华大学出版社