电磁组直立车的方案.pdfVIP

第七届全国大学生“飞思卡尔”杯智能汽车竞赛 电磁组直立行车参考设计方案 （版本1.0 ） 直直直直 直直 直直 直直直直 竞赛秘书处 2011-12-22 1 目 录 一、前言 3 二、原理篇 5 2.1 直立行走任务分解 5 2.2 车模直立控制 6 2.3 车模速度控制 10 2.4 车模方向控制 13 2.5 车模倾角测量 14 2.6 车模直立行走控制算法总图 18 三、电路设计篇 20 3.1 整体电路框图 20 3.2 DSC 介绍与单片机最小系统 21 3.3 倾角传感器电路 24 3.4 电机驱动电路 26 3.5 速度传感器 27 3.6 电磁线检测电路 28 四、机械设计篇 29 4.1 车模简化改装 29 4.2 传感器安装 30 4.3 注意事项 32 五、软件编写与调试篇 33 5.1 软件功能与框架 33 5.2 DSC 的资源配置 36 5.3 主要算法及其实现 37 5.4 程序调试与参数整定 45 5.5 现场运行测试 46 六、结束语 46 附录： 47 2 一、前言 为了提高全国大学生智能汽车竞赛创新性和趣味性，激发高校学生参与比赛的兴 趣，提高学生的动手能力、创新能力和接受挑战能力，智能汽车竞赛组委会将电磁组比 赛规定为车模直立行走 （如图1.1 所示），其它两个组别的车模行走方式保持不变。 图1.1 电磁组车模直立运行模式 车模直立行走比赛是要求仿照两轮自平衡电动车的行进模式，让车模以两个后轮 驱动进行直立行走。近年来，两轮自平衡电动车以其行走灵活、便利、节能等特点得到 了很大的发展。国内外有很多这方面的研究，也有相应的产品。在电磁组比赛中，利用 了原来C 型车模双后轮驱动的特点，实现两轮自平衡行走。相对于传统的四轮行走的车 模竞赛模式，车模直立行走在车体检测、控制算法等方面提出了更高的要求。为了能够 帮助参赛同学尽快制作车模参加比赛，竞赛秘书处编写了C 型车模直立行走的参考设计 方案。参赛队员可以在此基础上，进一步改进硬件和软件方案，提高竞赛水平。 为了适应初学者，方案介绍过程中，尽可能减少公式推导，使用通俗科学的语言介 绍控制原理和方法，给出C 型车模制作过程中的核心环节。本文的主要内容如图1.2 所 示。 3 电磁组直立行走任务分解 车模直立控制 车模速度控制 原理篇 车模方向控制 车模倾角测量 控制算法总框图 整体电路框图 DSC最小系统 倾角传感器电路 电路设计篇 电机驱动电