下载文档原格式
双轮平衡车控制系统的设计摘要随着时代的发展，人们生活质量的提高，双轮平衡车已经成为越来越流行的交通工具，目前双轮平衡车的发展已经成为未来交通工具发展的重要方向。
在实际使用中，双轮平衡车的反应速度，稳定性已是制衡双轮平衡车使用体验的最重要指标。
为双轮平衡车提供一种高效准确的运动控制系统成为了拓展其应用范围的前提。
本文是在基于嵌入式微处理器平台上，选择姿态传感器，设计了一种低成本、高性能、高准确性的双轮平衡车的控制系统。
本文首先从双轮平衡车的理论基础开始研究双轮平衡车的控制系统，依据现代受力分析和动能理论对车体进行数学建模，在数学模型的基础上设计合理的控制算法。
之后设计双轮平衡车机械结构，主要分为车轮、车架、电机等机械结构。
在设计平衡车硬件电路时，主要使用ARM结构的微处理器处理算法并且控制整体电路模块，使用高效的姿态传感器MPU6050采集车体的姿态信息，采用电机驱动芯片驱动电机。
最后编制双轮平衡车控制系统的程序，采用卡尔曼滤波算法对采集到的姿态信息进行抗干扰处理。
通过计算，主控制器输出PWM波驱动电机维持系统整体稳定并保持姿态平衡。
本次设计实现了抗干扰能力强和高效稳定的平衡车控制系统，该平衡车系统不仅平稳运行，并可以成功从不稳定状态恢复平衡，基本实现了基本功能。
本次设计可以使双轮平衡车这种交通工具更好的符合人们的日常需求。
关键词双轮平衡车；数学模型；PID控制；卡尔曼滤波- I -Design of the Control System ofDoubleWheel Balance CarAbstractWith the development of the times,people's living standards gradually improve.Thedouble wheel balance car has become amore popular part in modern transportation field.The response speed and stability of the two double balancecars has gradually become an important index of check and balance the double wheel balance vehicle technical performance. For the two-wheel balancing car provides an efficient and accurate motion control system became the premise of expanding the scope of its applicationThis paper is based on embedded microcontroller processor platform,choice attitude sensor, designed a low cost, high performance, high accuracy ofthedouble wheel balancing car control system.This paper begins with the theory of two wheel balancing car.According to modernforce analysis andenergy theory to design a mathematical model. According to the mathematical model todesign reasonable control algorithm. Second, design a Reasonable mechanical structure, including wheels, frame and motor. Now the most important thing is to design the hardware circuit. The ARM structure is used as the main control unit, it is mainly used for the operation and control of other units. Using an efficient attitude sensor to collect right attitude information, this paper select MPU6050 as the attitude sensor. Motor drive chip is used to drive two motors. Finally, this paper programs the two wheel balance control program. Filtering the collected information by Kaman filtering. After calculation, the main controller outputs the PWM wave to drive motor to maintain the overall balance of the car body.The double wheel balance car has Strong anti-interference ability.The double wheel balance car can maintain body balance, it can quickly restore balance.It accords with basic conditionsand greatly improves the stability of the whole system. Achieve the basic function;the double wheel balance car meets the People's daily life.- II -Keywords double wheel balance car; mathematic model; PID control; kalman filtering- III -目录摘要 (I)Abstract (II)第一章绪论 (1)1.1课题研究背景及意义 (1)1.2国内外双轮平衡车的发展现状 (2)1.3主要研究内容 (3)第二章系统总体设计及技术介绍 (5)2.1双轮平衡车总体设计方案 (5)2.2双轮平衡车受力分析以及动力学模型 (6)2.2.1双轮平衡车平衡的基本原理 (6)2.2.2车轮受力分析 (7)2.2.3车身受力分析 (9)2.2.4系统动能分析 (11)2.3PID控制算法 (16)2.3.1 PID控制系统简介 (16)2.3.2 PID控制算法原理 (16)2.4卡尔曼滤波算法 (22)2.4.1卡尔曼滤波简介 (22)2.4.2卡尔曼滤波原理 (23)2.4.3卡尔曼滤波实现 (24)2.5本章小结 (25)第三章系统硬件设计 (26)3.1双轮平衡车系统结构设计 (26)3.1.1平衡车机械机构设计 (26)3.1.2平衡车控制系统硬件设计方案 (27)3.2主控制器应用电路设计 (28)3.2.1Stm32处理器简介 (28)3.2.2主控制模块 (29)3.3无线通信模块电路设计 (30)3.3.1无线通信模块简介 (30)3.3.2无线通信模块 (31)3.4电源电路设计 (31)3.5硬件中的抗干扰措施 (33)3.6电机驱动电路设计 (33)3.7姿态传感器模块 (36)3.8本章总结 (38)第四章系统软件设计 (39)4.1软件设计总框图 (39)4.2电机测速方法 (41)4.2.1M法测速 (41)4.2.2T法测速 (42)4.3MPU6050通信程序 (42)4.4通信程序的设计 (43)4.5卡尔曼滤波程序设计 (44)4.6PID算法程序设计 (46)4.7本章小结 (47)第五章双轮自平衡车测试 (48)5.1双轮平衡车调试 (48)5.2PID控制系统测试 (48)5.3抗干扰试验 (50)5.4本章小结 (52)结论 (53)参考文献 (54)攻读硕士学位期间发表的学术成果 (57)致谢 (58)第一章绪论1.1课题研究背景及意义在当今世界，人们的交通方式的发展有着多样化的趋势，特别是时代的进步和发展，人们的交通工具已经不能只考虑速度、体积等方面，人们需要更可以用传感器反馈分析和智能控制和规划的自主交通工具[1]。
此时系统两个极点为:图1总体结构图通过比较,对各模块做如下选择。
控制系统模块,采用AVR(ATmega16)单片机。
角度控制模块采用MMA7361。
陀螺仪模块采用图2总体系统电路原理图L298N电机驱动电路原理图传感器模块转接电路115Science&Technology Vision科技视界图3软件流程图5结论两轮自平衡小车是一个集多种功能于一体的综合系统,是自动控制理论与动力学理论及技术相结合的研究课题,其关键问题是在完成自身平衡的同时,还能够适应各种环境下的控制任务。
它是一种两轮共轴、独立驱动、车身中心位于车轮轴上方,通过运动保持平衡,可直立行走的复杂系统。
由于特殊的结构,其适应地形变化能力强,运动灵活,可以胜任一些复杂环境里的工作。
【参考文献】[1]黄有锐,曲立国.PID控制器参数整定与实现[M].北京:科学出版社,2010.[2]范世珣,范大鹏,张智永,孙海洋.机电装置频率特性的数字化测试方法研究[J].动力学与控制学报,2007,5.[3]丁学明,张培仁,杨兴明,徐勇明.基于单一输入法的两轮移动式倒立摆运动控制[J].系统仿真学报,2004,16.[4]K Pathak,J Franch,S K Agrawal.Velocity and Position Control of a WheeledInverted Pendulum by Partial Feedback Linearization[J].IEEE Trans.on Robotics,2005.的缘故。
(a)“电阻率-温度”关系图(0-300K)(b)“电阻率-温度”关系图(0-10K)图3图(a)为NdOFeP的电阻率与温度(2K至300K)的关系曲线图,图(b)为NdOFeP的电阻率与温度(2k至10K)的关系曲线大图。
(2)NdOFeP的磁性测量过程由于NdOFeP中含有微量的磁性杂质,抑制了样品本身的磁性质。
基于STM32的两轮自平衡小车控制系统设计本文主要对两轮自平衡小车的姿态检测算法、PID控制算法两方面进行展开研究。
用加速度传感器和陀螺仪传感器融合而成的姿态传感系统与互补滤波器组合得到自平衡小车准确而稳定的姿态信息，然后PID调节器则利用这些姿态信息输出电机控制信号，控制电机的转动，从而使小车得以平衡。
标签：STM32；自平衡小车；控制系统；控制算法1 研究意义应用意义：两轮平衡车是一种新型的交通工具，它与电动自行车和摩托车车轮前后排列方式不同，而是采用两轮并排固定的方式，就像一种两轮平行的机器人一样。
两轮自平衡控制系统是一种两轮左右平行布置的，像传统的倒立摆一样，本身是一个自然不稳定体，必须施加强有力的控制手段才能使之稳定。
两轮平衡车具有运动灵活、智能控制、操作简单、节省能源、绿色环保、转弯半径为0等优点。
因此它适用于在狭小空间内运行，能够在大型购物中心、国际性会议或展览场所、体育场馆、办公大楼、大型公园及广场、生态旅游风景区、城市中的生活住宅小区等各种室内或室外场合中作为人们的中、短距离代步工具。
具有很大的市场和应用前景。
理论研究意义：车体状态运算主要是将各传感器测量的数据加以融合得出车体倾斜角度值、倾斜角速度值以及行车速度等。
平衡控制运算根据车体状态数据，计算保持平衡需要的行车速度和加速度，或者转弯所需要的左右电机速度变化值，向电机控制驱动模块发送控制指令。
运算模块相当于两轮自平衡电动车的大脑，它主要负责的工作是：控制电机的起停，向控制模块发出加速、减速、电机正反转和制动等速度控制信号，接收电机Hall信号进行车速度计算，并通过RS 一232串口向PC发送车速数据以供存储和分析。
另外，还负责接收车体平衡姿态数据，进行自平衡运算。
现有的自平衡车结构种类繁多，但车体都归根于由三层的基本结构组成，从上到下依次是电池层、主控层、电机驱动层。
电池层用于放置给整个系统供电的6V锂电池，主控层由主控芯片系统和传感器模块组成，电机驱动层接受单片机信号，并控制电机。
基于两轮自平衡小车的测控系统课程设计教学改革1. 引言1.1 研究背景两轮自平衡小车是一种具有自主平衡能力的智能移动机器人，具有在不借助外部支撑的情况下保持平衡的能力。
随着人工智能和机器人技术的不断发展，两轮自平衡小车在教育领域中的应用日益广泛。
传统的测控系统课程设计通常注重理论知识的传授，缺乏实际操作和动手能力的培养，因此需要进行教学改革，以适应现代教育的发展需求。
在当前高等教育中，教学模式的转变是必然的趋势，传统的课堂讲授已不能满足学生的学习需求，因此需要将课程设计与实践相结合，培养学生的实际动手能力和创新思维。
基于两轮自平衡小车的测控系统课程设计教学改革正是针对这一需求而展开的重要举措。
通过引入实际操作环节，学生可以在课堂上亲自动手操控两轮自平衡小车，深入理解测控系统的原理和应用，提高他们的实际操作能力和问题解决能力。
这一教学改革将有助于激发学生的学习兴趣，培养他们的创新精神和团队合作意识，促进他们在未来的工程实践中发挥更大的作用。
1.2 问题陈述在传统的测控系统课程设计教学中，学生往往面临着难以真正理解理论知识、缺乏实践能力、缺乏创新思维等问题。
尤其是对于基于两轮自平衡小车的测控系统课程设计，学生需要掌握的知识和技能更加复杂和抽象，传统的教学方法已经不能完全满足学生的需求。
问题陈述部分主要关注的是如何有效解决传统测控系统课程设计教学中存在的种种问题。
具体来说，包括如何提高学生对测控系统理论知识的理解和应用能力，如何培养学生的实践操作技能和创新思维，如何激发学生学习的兴趣和潜能等方面的问题。
通过解决这些问题，可以提高学生的学习效果和实践能力，为他们未来的科研和工作奠定坚实的基础。
本课程设计的教学改革旨在通过创新教学内容和方法，优化实践教学环节设计，改进实验室建设，进行课程效果评估等措施，有效解决传统测控系统课程设计教学中存在的问题，提高学生的学习效果和实践能力，为培养具有创新精神和实践能力的测控领域专业人才做出积极贡献。
基于MC9S12XS128的双轮平衡车控制系统设计［摘要］本文主要介绍了双轮平衡车的控制系统设计方案。
采用MC9S12XS128作为核心控制器，在此基础上增加了各种接口电路板组成整个硬件系统，包括单片机最小系统，直流驱动电机控制模块，电源管理模块，测速编码模块，人机交互等模块。
软件调试部分依次对应硬件各模块进行程序设计，包括A/D模块，PWM模块，ECT模块，PID控制算法，人机交互控制等。
完成车模的制作和软件设计后对整个控制系统进行调试，先阐述了调试的策略，再分别就现有调试工具条件下的软件和硬件调试进行了分析，对相应的调试方法做了基本的介绍。
最后根据调试情况对整个系统做了修改，基本达到设计要求。
［关键词］双轮平衡车；MC9S12XS128；模块设计；调试策略Based On MC9S12XS128 of the Two-wheeled BalancingVehicle Control System DesignElectrical Engineering and Automation Specialty CHEN MingAbstract: This article mainly introduces the balance of the Two-wheeled balancing vehicle control system design scheme. The MC9S12XS128 as core controller, on the basis of interface circuit board of increasing the hardware system, including single chip minimize system, dc motor control module, power management module, code modules speed, man-machine interaction module. Software debugging session in the corresponding module design program, including A/D module, PWM module, ECT module, PID control algorithm, the man-machine interactive control, etc. Accomplish the production and the software design draw after the whole control system for debugging, first expounds the commissioning of the strategy, second，different debugging tools under the conditions of existing software and hardware debugging are analyzed, the corresponding debugging method basic introduction. According to the situation of the whole system debugging have modified, basic to meet the design requirements.Key words: the Two-wheeled balancing vehicle; MC9S12XS128; MODULAR DESIGN ; Debugging strategy目录1 引言 (1)1.1 双轮自平衡小车的研究意义 (1)1.2 双轮自平衡小车的发展历程和现状 (1)1.2.1国外的研究成果 (2)1.2.2国内的研究成果 (2)1.3 本课题的研究内容和关键问题 (2)2 双轮平衡小车系统的总体概述 (3)2.1 系统组成 (3)2.2 系统各模块的主要功能 (3)2.3 系统的主要特点 (4)3 双轮平衡小车硬件电路设计 (4)3.1 整体电路设计 (4)3.2 单片机最小系统 (5)3.3 直流驱动电机控制电路 (6)3.4 电源模块电路设计 (6)3.5 测速编码电路设计 (7)3.5.1 陀螺仪电路 (8)3.5.2 编码器电路 (8)3.6 人机交互接口电路设计 (9)3.6.1CAN总线与LIN总线设计 (9)3.6.2通信接口设计 (10)3.6.3人机交互电路设计 (10)4 双轮平衡小车软件设计 (11)4.1 软件模块功能与框架 (11)4.1 A/D模块 (12)4.1.1A/D转换原理 (12)4.1.2A/D转换模块功能结构 (12)4.1.3A/D转换模块的编程步骤 (13)4.2 PWM模块 (13)4.2.1PWM的主要特点 (13)4.2.2PWM应用及初始化 (14)4.3 ECT模块 (14)4.4 PID控制算法 (15)4.4.1PID控制原理 (15)4.4.2 PID参数的整定 (16)4.5 人机交互 (16)4.5.1 LCD液晶显示 (16)4.5.2 矩阵键盘按键识别 (17)4.5.3 串口与上位机的通讯 (17)5 双轮平衡小车的系统调试 (18)5.1 调试策略 (18)5.1.1硬件调试 (18)5.1.2软件调试 (18)5.1.3综合调试 (18)5.2 串口调试 (18)5.2 监控调试 (20)5.3 无线调试 (21)5.3.1无限遥控开关 (21)5.3.2无线通信模块 (21)6 结论 (23)参考文献 (24)附录1：单片机最小系统原理图 (25)附录2：单片机最小系统电路图 (26)附录3：单片机最小系统PCB图 (26)致谢 (27)1 引言本章简要的介绍了两轮自平衡小车的起源与发展、研究意义以及国内外的研究现状，并依此提出了本论文研究的主要内容。
两轮自平衡小车毕业设计毕业设计题目：两轮自平衡小车设计一、毕业设计背景与意义目前，智能机器人技术已经在各个领域得到广泛的应用，其中自平衡小车是一种非常具有代表性的机器人。
自平衡小车能够通过自身的控制系统来保持平衡姿态，并能够实现各种转向和动作。
因此，自平衡小车不仅能够广泛应用于工业生产中，还可以成为搬运、巡逻和助力等领域的优秀协助工具。
本毕业设计的目标是设计和实现一种能够自动控制、实现平衡的两轮自平衡小车。
通过这个设计，进一步探究并研究自平衡技术的原理及应用，增加对机器人控制系统和传感器的理解，提高对计算机控制和嵌入式系统的应用能力。
二、毕业设计的主要内容和任务1.研究和调研a)研究两轮自平衡小车的构造和原理；b)调研目前市场上相关产品，并分析其特点和存在的问题。
2.模块设计a)根据研究结果，设计自平衡小车的主要模块，包括平衡控制模块、动作控制模块和传感器模块；b)设计相关控制算法和策略，使小车能够保持平衡并能够实现转向和动作。
3.硬件搭建和调试a)根据模块设计的结果，搭建小车的硬件系统，包括选择适用的电机、陀螺仪、加速度计等；b)进行相应的调试和优化，保证小车的平衡和动作控制能力。
4.软件开发和系统集成a)开发小车的控制系统软件，包括实时控制系统和传感器数据处理等；b)将硬件系统和软件系统进行有机地集成，实现小车的平衡和动作控制。
5.实验和测试a)进行实验测试，验证设计的有效性和稳定性；b)进行相关的性能测试和比较研究。
三、设计预期成果1.自平衡小车的系统设计和实现，能够平衡姿态并能够实现转向和动作控制；2.控制系统软件的开发和优化，实现小车的实时控制和数据处理；3.相关模块和算法的设计和实现，如平衡控制模块和动作控制模块；4.实验和测试结果的总结和分析；5.毕业设计报告的撰写。
四、设计周期和工作安排1.阶段1：研究和调研阶段（1周）2.阶段2：模块设计阶段（2周）3.阶段3：硬件搭建和调试阶段（2周）4.阶段4：软件开发和系统集成阶段（2周）5.阶段5：实验和测试阶段（1周）6.阶段6：总结和报告撰写阶段（2周）五、预期解决的关键问题和技术难点1.小车平衡控制算法的设计和优化；2.小车动作控制算法的设计和优化；3.小车硬件系统与软件系统的有效集成；4.多个传感器数据的处理和融合。
两轮自平衡车控制系统的设计与实现一、自平衡车系统概述1、定义自平衡车是一种以双轮直立结构/双轮平移结构的小型无线遥控电动车，最初由电动车作为主要的运动机构，但也有可能有其他特殊机构，进行实时控制，使其能够在平衡和模式控制下，保持水平稳定态，实现自动平衡、自主康复和自由行走。
2、系统功能自平衡车系统的功能是通过实时控制平衡并实现模式控制，使自平衡车实现自动平衡、自主康复和自由行走，从而达到智能化的操作目的，解决双轮自行车无主动平衡功能的问题。
二、系统设计1、硬件系统自平衡车的硬件系统由电池、ESC（电子转向控制器）、遥控组件、周边传感器组件、电路板组件等构成。
2、软件系统自平衡车的控制系统主要由ARMCortex-M0 MCU、单片机程序、PID算法组成。
三、系统实现1、硬件系统实施（1）第一步，在自平衡车上安装ESC，ESC的电池由智能充电器连接，使自平衡车进行自动充电；（2）第二步，给控制器方向键插上遥控器，使用户可以控制车辆移动；（3）第三步，在车辆上安装多个传感器，在控制板上增加芯片，使用户可以对车辆进行实时监测；（4）第四步，在控制板上安装一个ARM Cortex-M0 MCU处理器，将控制算法由单片机程序烧录形成可控制的处理系统。
2、软件系统实施（1）随着ARM处理器的安装，自平衡车可以被SONI的特殊的烧录器进行烧录，该程序可以控制车辆的转向和速度；（2）安装完毕后，需要建立多个变量从传感器接受数据，读取车辆的平衡状态，并控制车辆前后左右的运动；（3）最后，我们选择PID算法来实现车辆实时的控制，根据车辆当前的实际情况，调节PID距离和速度增量使自平衡车实现实时的模式控制。
四、结论本文介绍了自平衡车控制系统的设计思想和实现步骤，通过控制平衡，实现自动平衡、自主康复和自由行走，使得自平衡车有更多的功能，在以后的应用中，自平衡车的研究和应用实际会有很大的推动作用。
两轮自平衡小车控制系统的设计摘要：介绍了两轮自平衡小车控制系统的设计与实现，系统以飞思卡尔公司的16位微控制器MC9S12XS128MAL作为核心控制单元，利用加速度传感器MMA7361测量重力加速度的分量，即小车的实时倾角，以及利用陀螺仪ENC-03MB测量小车的实时角速度，并利用光电编码器采集小车的前进速度，实现了小车的平衡和速度控制。
在小车可以保持两轮自平衡前提下，采用摄像头CCD-TSL1401作为路径识别传感器，实时采集赛道信息，并通过左右轮差速控制转弯，使小车始终沿着赛道中线运行。
实验表明，该控制系统能较好地控制小车平衡快速地跟随跑道运行，具有一定的实用性。
关键词：控制；自平衡；实时性近年来，随着经济的不断发展和城市人口的日益增长，城市交通阻塞以及耗能、污染问题成为了一个困扰人们的心病。
新型交通工具的诞生显得尤为重要，两轮自平衡小车应运而生，其以行走灵活、便利、节能等特点得到了很大的发展。
但是，昂贵的成本还是令人望而止步，成为它暂时无法广泛推广的一个重要原因。
因此，开展对两轮自平衡车的深入研究，不仅对改善平衡车的性价比有着重要意义，同时也对提高我国在该领域的科研水平、扩展机器人的应用背景等具有重要的理论及现实意义。
全国大学生飞思卡尔智能车竞赛与时俱进，第七届电磁组小车首次采用了两轮小车，模拟两轮自平衡电动智能车的运行机理。
在此基础上，第八届光电组小车再次采用两轮小车作为控制系统的载体。
小车设计内容涵盖了控制、模式识别、传感技术、汽车电子、电气、计算机、机械及能源等多个学科的知识。
1 小车控制系统总体方案小车以16位单片机MC9S12XS128MAL作为中央控制单元，用陀螺仪和加速度传感器分别检测小车的加速度和倾斜角度[1]，以线性CCD采集小车行走时的赛道信息，最终通过三者的数据融合，作为直流电机的输入量，从而驱动直流电机的差速运转，实现小车的自动循轨功能。
同时，为了更方便、及时地观察小车行走时数据的变化，并且对数据作出正确的处理，本系统调试时需要无线模块和上位机的配合。
两轮自平衡小车设计一、任务要求图1两轮自平衡车两轮自平衡车结构原理如图1所示，主控制器（DSP）通过采集陀螺仪和加速度传感器得到位置信号，通过控制电机的正反转实现保持小车站立。
1、通过控制两个电机正反运动，实现小车在原地站立。
2、实现小车的前进、后退、转弯、原地旋转、停止等运动；二、方案实现2.1电机选型图2直流电机两轮自平衡车由于需要时刻保持平衡，对于倾角信号做出快速响应，因此对电机转矩要求较大。
在此设计中选用国领电机生产的直流电机，其产品型号为GB37Y3530，工作电压6v-12v。
为增大转矩，电机配有1:30传动比的减速器。
2.2电机测速方案图3霍尔测速传感器在电机测速方案上主流的方案有两种，分别是光电编码器和霍尔传感器。
光电编码器测量精度由码盘刻度决定，刻度越多精度越高；霍尔传感器精度由永磁体磁极数目决定，同样是磁极对数越高精度越高。
由于两轮自平衡车工作于剧烈震动环境中，光电编码器不适应这种环境，因此选用霍尔传感器来测量速度。
电机尾部加装双通道霍尔效应编码器，AB双路输出,单路每圈脉冲16CPR,双路上下沿共输出64CPR，配合1:30的减速器传动比，可以计算出车轮转动一圈输出的脉冲数目为64X30=1920CPR，完全符合测速要求。
2.3电机驱动控制系统概述本平台电机驱动采用全桥驱动芯片L298N，内部包含4通道逻辑驱动电路，两个H-Bridge的高电压、大电流双全桥式驱动器。
本驱动桥能驱动46V、2A 以下的电机。
其输出可以同时控制两个电机的正反转，非常适合两轮自平衡车开发，其原理图如下图所示图4L298N原理图采用脉宽调制方式（即PWM，Pulse Width Modulation）来调整电机的转速和转向。
脉宽调制是通过改变发出的脉冲宽度来调节输入到电机的平均电压，即通过不同方波的平均电压不同来改变电机转速。
图5PWM脉宽调节示意2.4倾角位置采集倾角和角速度采集是两轮自平衡车控制的重点，选用MPU6050模块作为其采集模块。
基于单片机的两轮自平衡车控制系统设计摘要两轮自平衡车是一种高度不稳定的两轮机器人，就像传统的倒立摆一样，本质不稳定是两轮小车的特性，必须施加有效的控制手段才能使其稳定。
本文提出了一种两轮自平衡小车的设计方案，采用重力加速度陀螺仪传感器MPU-6050检测小车姿态，使用互补滤波完成陀螺仪数据与加速度计数据的数据融合。
系统选用STC公司的8位单片机STC12C5A60S2为主控制器，根据从传感器中获取的数据，经过PID算法处理后，输出控制信号至电机驱动芯片TB6612FNG，以控制小车的两个电机，来使小车保持平衡状态。
整个系统制作完成后，小车可以在无人干预的条件下实现自主平衡，并且在引入适量干扰的情况下小车能够自主调整并迅速恢复至稳定状态。
通过蓝牙，还可以控制小车前进，后退，左右转。
关键词：两轮自平衡小车加速度计陀螺仪数据融合滤波PID算法Design of Control System of Two-WheelSelf-Balance Vehicle based on MicrocontrollerAbstractTwo-wheel self-balance vehicle is a kind of highly unstable two-wheel robot. The characteristic of two-wheel vehicle is the nature of the instability as traditional inverted pendulum, and effective control must be exerted if we need to make it stable. This paper presents a design scheme of two-wheel self-balance vehicle. We need using gravity accelerometer gyroscope sensor MPU6050 for the inclination angle of vehicle, and using complementary filter for the data fusion of gyroscope and accelerometer. We choose an 8-bit microcontroller named STC12C5A60S2 from STC Company as main controller of the control system. The main controller output control signal, which is based on the data from the sensors, to the motor drive chip named TB6612FNG for controlling two motors of vehicle, and keeping the vehicle in balance. After the completion of the control system, the vehicle can achieve autonomous balance under the conditions of unmanned intervention, the vehicle can adjust automatically and restored to a stable state quickly in the case of giving appropriate interference as well. In addition, we can control the vehicle forward, backward and turn around.Key words: Two-Wheel Self-Balance Vehicle; Accelerometer; Gyroscope; Data fusion; Complementary filter; PID algorithm1 绪论 (1)1.1自平衡小车的研究背景 (1)1.2 自平衡小车研究意义 (1)1.3 论文的主要内容 (2)2 课题任务与关键技术 (2)2.1 主要任务 (2)2.2关键技术 (2)2.2.1 系统设计 (2)2.2.2 数学建模 (2)2.2.3姿态检测 (3)2.2.4 控制算法 (3)3 系统原理分析 (3)3.1 控制系统任务分解 (3)3.2 控制原理 (4)3.3 数学模型 (5)4 系统硬件设计 (6)4.1 STC12C5A60S2单片机介绍 (7)4.2 电源管理模块 (8)4.3 车身姿态感应模块 (9)4.3.1 加速度计 (10)4.3.2 陀螺仪 (12)4.4 电机驱动模块 (14)4.5 速度检测模块 (16)5 系统软件设计 (16)5.1 软件系统总体结构 (17)5.2 单片机的硬件资源配置 (18)5.2.1定时/计数器设置 (18)5.2.2 PWM输出设置 (20)5.2.3 串行通信设置 (23)5.2.4 中断的开放与禁止 (26)5.3 MPU6050资源配置 (27)5.3.1 普通IO口模拟IIC通讯 (28)5.3.2 MPU6050资源配置 (32)5.4 系统控制算法设计 (34)5.4.1 PID算法 (34)5.4.2 互补滤波算法 (35)5.4.3 角度控制与速度控制 (35)5.4.4 输出控制算法 (36)6 总结与展望 (37)6.1 总结 (37)6.2 展望 (37)参考文献 (38)1 绪论1.1自平衡小车的研究背景近几年来，随着电子技术的发展与进步，移动机器人的研究不断深入，成为目前机器人研究领域的一个重要组成部分，并且其应用领域日益广泛，其所需适应的环境和执行的任务也更复杂，这就对移动机器人提出了更高的要求。
