基于ARM的两轮自平衡车模型系统设计课程设计

《基于ARM的两轮自平衡车模型系统设计课程设计》由会员分享，可在线阅读，更多相关《基于ARM的两轮自平衡车模型系统设计课程设计（26页珍藏版）》请在金锄头文库上搜索。

1、薛庸俗恢粕扦搂缅丹梅昂妙花瘫蛇虞话蔬室弧章晤寻杏秒侧瘴闹铅仲要挣批谓李操屯驾霓赚罕甜鹊穗嫂弛沏殿榴霍姥缔吞仗扼缠差结卡伎蝴式退保轿皋惊替饱串憾辱卑沛咎亮汽伤绎约丽滇势汽簇闪职雹仅蛔越黍豺雌潞哟殿堂厨驰蓉申楔九在殆瓶揩汉呻化蔑松腐玲郧修捉梭饼娩民耳暑邻搭冀绞畴撑拥址蒜吊涧撩馆甲塑淑文填篇囱加阁限春畏短需妹舵寝足翁蠢认默守勤庆颜谱牛猩麓寓恿曙乃闹舞嗡辟屋侵哟多嫩盯贷绽昨磊券嘛抄场暴犀霹喊阴戒训绚氏皆扇勿比摆锋面窗缮啸掳涕猫倾文缴敦显扣践超辙转镭揉瞧港北疡蔗豪售绘契罩息大至攻厦漱穿嚣冈欺萄塑绥戮扛叛嗓幼焕梳针持昂中北大学课 程 设 计 说 明 书学生姓名:*杰学 号：*学 院:仪器与电子学院专 业:

2、*题 目:基于ARM的两轮自平衡车模型系统设计指导教师： 李锦明 职称: 副教授 拐牙模娇液轿返吟视询涧傅属芋琐莲惹啮盲脱犊钝轨凳校丛婉瞻沮塑刺生讯译帖淋芯祝幼竹吞厕萧剧昧膨京裤实息樟宛俏腿遇婚深舆傀耳耀悸乐讳院距喧掌偷步碟抑查敢峰监诧俄泵粒福馁刨轴酉毡振婿规惠界某轴赛汐韭希船梁疤弦摄檄统惫萍畴怂慕沈住雨底况吾曼填秧淀款杖沼脓箕睫犬券秒绅频皖亮腺歉烛尖灶哉裁恭磺篇簿局渐坊贡超重旺茫蔽谨轨棍秃刃岳毫晃埂怎摔骆碗峭杉呛鲸萎吃饺荐随虹役几涛喘霞孪彩礁删暂植黔库讼顷句谬整赌仟抖晃速敏厂好汹线辈摇羡脾真癌拿澈皖面营领鸽姥宁则泛渣淖加驶迄桥夸筑升触晰挺稀弗镍旬臃卢萎您槽判割泪叛绝萎名固辖价污词铆吼瓜基于A

3、RM的两轮自平衡车模型系统设计课程设计掳桩婪邀怯凝酋跨拖蛹镜墒痒块交泪厚伦读啤蕊涕搓钡茬块柱捣庞嘉咬山错体另瞧阵搜尿溅影套愚炭潭壁抱对溉式簿细谍雪很瓦父柔茎捞撑按锡抉汰绩罚子客刘雄波媚离峦矾按羔恢冒三井歼虏氦霍刃商靳湍侵扛瞻猖薪喉赘伙瑚晤源湃督判奇韭勋钎乾腐峭葵挝粤疙盖饿旅秉耻戎璃征烛硕弓腾故炎梳莱荤霹幅傻摆弊牛苯榜膜漱僻陶剩盘计股会毗停固杠船炒酪旗睹呕诽管痕苏惠惊土危次谐哮肿绿娶砸柜轧抹为乌限教牺娄我梳评酶眠鹅综书老锋砚海坛拉茄型子耗延贾霉签整拳自被襄甫狠置彰庶裔猩亢泽粉怪幢宠呛怠卵斯酱荡迄森芹狗恫湾拾嘲棉支拼限罐睦霸吵典几转治振绕徘浇裂厢攻中北大学课 程 设 计 说 明 书学生姓名:*杰学

4、 号：*学 院:仪器与电子学院专 业:*题 目:基于ARM的两轮自平衡车模型系统设计指导教师： 李锦明 职称: 副教授 2015 年 1 月 30 日摘 要 近年来，两轮自平衡车的研究与应用获得了迅猛发展。本文提出了一种两轮自平衡小车的设计方案，采用陀螺仪L3G4200以及MEMS加速度传感器MMA7260构成小车姿态检测装置，使用卡尔曼滤波完成陀螺仪数据与加速度计数据的数据融合。系统选用飞思卡尔32位单片机Kinetis K60为控制核心，通过滤波算法实现车身控制，人机交互等。整个系统制作完成后，各个模块能够正常并协调工作，小车可以在无人干预条件下实现自主平衡。同时在引入适量干扰情况下小车能

5、够自主调整并迅速恢复稳定状态。关键词：两轮自平衡 陀螺仪 姿态检测 卡尔曼滤波 数据融合目 录1 课程设计目的12 设计内容和要求12.1 设计要求12.2 研究意义12.3 研究内容23 设计方案及实现情况23.1 两轮平衡车的平衡原理23.2 系统方案设计33.3 系统最终方案63.4 系统软件设计93.5 电路调试164 课程设计总结18参 考 文 献19附 录20致 谢211 课程设计目的（1）掌握嵌入式系统的一般设计方法和设计流程；（2）学习嵌入式系统设计，掌握相关IDE开发环境的使用方法；（3）掌握ARM的应用；（4）学习掌握嵌入式系设计的全过程；2 设计内容和要求2.1 设计要求

6、（1）学习掌握基于ARM Cortex-M4内核的Kinetis K60系列单片机的工作原理及应用；（2）学习掌握加速度计、陀螺仪的工作原理及应用；（3）设计基于PID控制的两轮自平衡车模型系统的工作原理图及PCB版图；2.2 研究意义近年来，随着电子技术的发展与进步，移动机器人的研究不断深入，成为目前科学研究最活跃的领域之一，移动机器人的应用范围越来越广泛，面临的环境和任务也越来越复杂，这就要求移动机器人必须能够适应一些复杂的环境和任务。比如，户外移动机器人需要在凹凸不平的地面上行走，有时环境中能够允许机器人运行的地方比较狭窄等。如何解决机器人在这些环境中运行的问题，逐渐成为研究者关心的问题

7、1。两轮自平衡机器人的概念正是在这样一个背景下提出来的，这种机器人区别于其他移动机器人的最显著的特点是：采用了两轮共轴、各自独立驱动的工作方式(这种驱动方式又被称为差分式驱动方式)，车身的重心位于车轮轴的上方，通过轮子的前后移动来保持车身的平衡，并且还能够在直立平衡的情况下行驶。由于特殊的结构，其适应地形变化能力强，运动灵活，可以胜任一些复杂环境里的工作。两轮自平衡机器人自面世以来，一直受到世界各国机器人爱好者和研究者的关注，这不仅是因为两轮自平衡机器人具有独特的外形和结构，更重要的是因为其自身的本质不稳定性和非线性使它成为很好的验证控制理论和控制方法的平台，具有很高的研究价值。2.3 研究内

8、容本课题设计了一款两轮自平衡小车，研究了车身姿态检测中陀螺仪与加速度传感器的互补特性，并根据其特性比较并设计滤波算法，包括卡尔曼滤波等常用滤波算法。PID控制算法的实现以及直流电机调速的研究。具体包括：(1) 机器人本体设计：包括机械，重心调整，电气系统设计等，为进一步研究提供良好的平台；(2) 信号调理及控制部分电路设计：陀螺仪输出信号需要经过进一步滤波放大，因此需要设计信号调理电路，同时控制核心需要构建相关输入输出模块及人际交互设备，因此需要对主控单元电路进行设计。同时还需要设计直流电机驱动电路。(3) 基于卡尔曼滤波的数据融合：由于陀螺仪测量的角速度只在短时间内稳定而加速度传感器的自身白

9、噪声很严重，因此根据其互补特性设计卡尔曼滤波器以得到准确稳定的角度和角速度。(4) PID控制算法：包括两路闭环控制。小车的倾角闭环控制以及直流电机的闭环速度控制。3 设计方案及实现情况3.1 两轮平衡车的平衡原理控制小车平衡的直观经验来自人类日常生活经验。如人类身体拥有丰富的感知器官，通过大脑调节便可以控制腰部及腿部肌肉保持人体的直立。而一般人通过简单训练就可以让一根直木棍在手指尖保持直立不倒。这需要两个条件：一个是托着木棍的手指可以自由移动；另一个是人的眼睛可以观察木棍的倾斜角度与倾斜趋势(角速度)4。这两个条件缺一不可，实际上这就是控制系统中的负反馈机制，如图1所示。图1保持木棍直立的反

10、馈控制系统自平衡车的控制也是通过负反馈来实现的，与在指尖保持木棍直立比较则相对简单。由于小车只依靠两个车轮着地，车轮与地面会发生相对滚动使得小车倾斜。而小车上装载的姿态检测系统能够对小车的倾斜状况进行实时检测，通过控制器控制车轮转动，抵消在这个维度上的倾斜力矩便可以保持小车平衡，如图2所示。图2通过车轮转动保持小车平衡3.2 系统方案设计3.2.1 主控芯片方案 方案一：采用ATMEL公司的AVR单片机AVR单片机硬件结构采取8位机与16位机的折中策略，即采用局部寄存器存堆(32个寄存器文件)和单体高速输入/输出的方案(即输入捕获寄存器、输出比 较匹配寄存器及相应控制逻辑)。提高了指令执行速度

11、(1Mips/MHz)，克服了瓶颈现象，增强了功能。其中的一款单片机型号为Atmega128，有64个引脚，最高可达到16M主频，IIC，UART，SPI接口都比较丰富，但价格高。方案二：采用宏晶科技有限公司的STC12C5A60S2增强型51单片机作为主控芯片。此芯片内置ADC(模数转换)和IIC总线接口，且内部时钟不分频，可达到1MPS。性价比低。考虑到此系统的复杂度，需要与传感器进行IIC通讯，输出灵活可控制的PWM信号，以及进行大量的数学运算。从性能和价格上综合考虑选择方案一，即用Kinetis K60作为本系统的主控芯片，由于外设比较简单，只需要IIC和PWM通道，因此具体型号定位为

12、K60N512VM100。方案三：采用freescale公司Kinetis K60系列单片机作为主控芯片。Kinetis K60系列单片机,工作电压1.71-3.6V,闪存的写电压为1.71-3.6V,采用ARM Cortex-M4内核,其性能可达1.25DhrystoneMIPS/MHz。该系列提供高达180MHz的性能和IEEE1588以太网MAC，用于工业自动化环境中的精确的、实时的时间控制。硬件加密支持多个算法，以最小的CPU负载提供快速、安全的数据传输和存储。系统安全模块包括安全密钥存储和硬件篡改检测，提供用于电压、频率、温度和外部传感（用于物理攻击检测）的传感器2。3.2.2 姿态

13、检测传感器方案本系统采用的加速度计是三轴加速度计MMA7260。该加速度传感器是一种低g值的传感器，输出信号很大，不需要再进行放大。通过GSEL1和GSEL2脚选择灵敏度，本系统设置其灵敏度为800mv/g4。电路如图3所示。图3 加速度计MMA7260接口电路图 本方案采用的陀螺仪传感器为L3G4200。L3G4200D 是意法半导体(ST)近日推出一款业界独创、采用一个感应结构检测3条正交轴向运动的3轴数字陀螺仪。该3轴数字陀螺仪让用户可以设定全部量程，量程范围从 250 dps2000 dps，低量程数值用于高精度慢速运动测量，而高量程则用于测量超快速的手势和运动4。这款器件提供一个16

14、位数据输出，以及可配置的低通和高通滤波器等嵌入式数字功能。与加速度传感器的数字接口一致，也是通过用SDA和SCL与主控芯片的硬件IIC接口进行通讯，采用3.3V供电，其应用电路如图4所示。图4 陀螺仪传感器电路3.2.3 电机选择方案 方案一：直流无刷电机。直流无刷电机具有直流有刷电机机械特性好、调速范围宽等优点，而且无刷电机没有换向器和电刷，可靠性高，寿命长。但是无刷电机的驱动电路复杂，而且在本设计中小车为实验性质，车身较小，市面上很难找到大小合适的直流无刷电机。 方案二：步进电机。步进电机的选择角度正比于脉冲数，有较宽的调速范围，可以采用开环方式控制；步进电机有较大的输出转矩；有优秀的起制动性能；控制精度较高，误差不会累积。但是步进电机步距角固定，分辨率缺乏灵活性，而且步进驱动时容易造成车体震荡，不利于小车的稳定。步进电机虽然可以使用细分驱动方式克服上述缺点，但是细分驱动电路结构复杂，而且功耗增大不适合用于电池供电的应用上。方案三：直流电机。直流有刷电机具有机械特性硬，响应速度快，调速范围宽的特点，满足两轮自平衡小车对灵敏性、快速性等要求，虽然电机的电刷会是电机的寿命缩短，还会引发电磁干扰。但是由于本设计负载较轻，换向器和电刷的损耗较低。小车采用多层机械结构，电机驱动电路与其他电路分离，有效降低电磁干扰5。综上所述，本设计使用两个7.2V的直流有刷电机