毕业论文-两轮自平衡车平衡控制系统的研究.doc

.装装订订线线.山东农业大学毕业论文两轮自平衡车平衡控制系统的研究两轮自平衡车平衡控制系统的研究院部机械与电子工程学院专业班级电气工程及其自动化2班届次2015届学生姓名学号指导教师二一五年六月六日i目录摘要.IAbstrat.II引言.11绪论.11.1两轮自平衡车的研究背景及研究意义.11.1.1两轮自平衡车的研究背景.11.1.2两轮自平衡车的研究意义.21.2两轮自平衡车的研究现状.21.2.1两轮自平衡车的国外研究现状.21.2.2两轮自平衡车的国内研究现状.31.3本课题的研究内容及目标.42自平衡系统的分析.42.1控制目标.42.2自平衡系统的控制学原理分析.52.2.1自平衡小车平衡原理解析.52.2.2自平衡小车的运动学模型分析.72.2.3自平衡小车的数学建模.93系统硬件组成.113.1惯性测量单元.113.1.1MPU6050芯片介绍.113.1.2MPU6050数据处理.123.1.3数据滤波算法.163.1.4MPU6050驱动电路.203.2主控单元.203.3电源模块.213.3.1LM2596芯片介绍.213.3.2AMS1117芯片介绍.223.4电机驱动模块.233.5编码器模块.244系统程序及算法.254.1MPU6050获取数据.254.1.1MPU6050初始化.264.1.2主函数中的姿态数据处理.265两轮自平衡车平衡控制的总结.35ii5.1设计的主要内容.355.2设计的不足.36参考文献.37致谢.38iiiContentsAbstract.IIIntroduction.11Exordium.11.1TheBackgroundofself-balancedcar.11.1.1TheBackground.11.1.2Researchmeaningofself-balancecar.21.2Thepresentsituationofresearchofself-balance.21.2.1Internetionalsituation.21.2.2TheresearchsituationofChina.31.3Goalofthisresearch.42Analysisofself-balancesystem.42.1Thepurposeofcontrolsystem.42.2ControlScienceAnalysis.52.2.1BalanceTheoryofself-balancedcar.52.2.2Kinesiologymodelanalysis.72.2.3Mathematicalmodeling.93Hardwarecomponent.113.1Inertialmeasurmentuint.113.1.1MPU6050introduction.113.1.2DateprocessingofMPU6050.123.1.3Algorithmofdatafilter.163.1.4DrivecircuitofMPU6050.203.2Maincontrolunit.203.3Powerunit.213.3.1IntroductionofLM2596.213.3.2IntroductionofAMS1117.223.4Motordriverunit.233.5Encoderunit.244Programandalgorithm.254.1MPU6050getdata.254.1.1InitialofMPU6050.264.1.2processinggesturedatainmainfunctiong.265Summarizeofbalancecontrolingofself-balancecar.355.1Mainsubstanceofthisproject.35iv5.2Blemishofthisproject.36Referencedocumentation.37Thanks.38I两轮自平衡车平衡控制系统的研究两轮自平衡车平衡控制系统的研究王恒（山东农业大学机械与电子工程学院泰安271018）摘要：自从在2008年北京奥运会上的精彩亮相，两轮自平衡车在中国市场已经逐渐为大众所接受。节能环保、便携新颖，两轮自平衡车以其独特的优势博取人们的青睐。又两轮自平衡小车以其一级倒立摆结构成为控制算法验证实现的独特平台。因此，两轮自平衡小车有较高的研究价值。本设计的重点是抓住两轮自平衡车的基础即平衡控制进行系统设计，结合姿态解算数据融合算法驱动直流电机以实现两轮小车的平衡控制。关键词：自平衡姿态解算数据滤波倒立摆IITheresearchofself-balancedcarcontrolsystemHengWang(MechanicalElectricalEngineeringCollegeofShandongAgriculturalUniversityTaianShandong271018)AbstractSincethefirstappearanceatthe2008BeijingOlympicCompetitiontwo-wheelbalancedcarhasbeenacceptedbymoreandmorepeople.Thetwo-wheelbalancedcarhastakenplaceofmanypeoplesheartbecauseofitsspecialcharacteristicjustasenvironmentalprotectionandeasy-taken.Thetwo-wheelself-balancedcarhasalsobecomeauniqueplatofcontrollingalgorithmbecauseofitssingleinverted-pendulumstructure.Sothetwo-wheelself-balancedcarhasahighvaluetobestudied.Thisdesignationwasbasedonthebasisoftwo-wheelbalancedcarandthatisbalanced-controlusingInertialmeasurementunittodetectthegestureofthecarandtacklethedatawithKalmanfilterdrivingthemotorwiththePIDcontroller.Keywords:self-balanceddestureanalysissingledatafilterinvertedpendulumstructure1引言引言新型交通方式越来越吸引人们的注意，北京奥运会上双轮自平衡车的亮相让人们眼前一亮。以电池作能源，清洁无污染，便携、灵活、新颖等优势使自平衡车迅速博得消费者的青睐。移动机器人是机器人学的一个重要分支，对于移动机器人的研究，包括轮式、腿式、履带式以及水下式机器人等，可以追溯到20世纪60年代。移动机器人得到快速发展有两方面原因：一是其应用范围越来越广泛；二是相关领域如计算、传感、控制及执行等技术的快速发展。移动机器人尚有不少技术问题有待解决，因此近几年对移动机器人的研究相当活跃。近年来，随着移动机器人研究不断深入、应用领域更加广泛，所面临的环境和任务也越来越复杂。机器人经常会遇到一些比较狭窄，而且有很多大转角的工作场合，如何在这样比较复杂的环境中灵活快捷的执行任务，成为人们颇为关心的一个问题。双轮自平衡机器人概念就是在这样的背景下提出来的。两轮自平衡小车是一个高度不稳定两轮机器人，是一种多变量、非线性、强耦合的系统，是检验各种控制方法的典型装置。同时由于它具有体积小、运动灵活、零转弯半径等特点，将会在军用和民用领域有着广泛的应用前景。因为它既有理论研究意义又有实用价值，所以两轮自平衡小车的研究在最近十年引起了大量机器人技术实验室的广泛关注。由于特殊的两轮结构，自平衡小车本身就是一个不稳定系统。如何让双轮小车在保持稳定的基础上实现前后行驶以及自由转向，成为一个技术上的问题。解决这一问题，将要用到机械设计和自动化专业的知识，涉及电子、机械、运动学、控制学等多学科知识。双轮自平衡车系统可进一步抽象化为一级倒立摆结构。经过对一级倒立摆结构的数学建模和运动学分析，结合控制学原理，可以得出使双轮自平衡车保持动态稳定的几个条件。（详见第二章自平衡系统的分析）双轮自平衡车平衡控制系统以STM32F103C8T6芯片作为主控芯片运用姿态传感器MPU6050，结合数据滤波算法进行数据融合，建立闭环控制系统驱动直流电机。再用编码器实时监测电机转速以反馈给主控系统，形成一个小闭环。最终能够实现双轮自平衡车的平衡控制。（详见第三章系统硬件组成）1绪论绪论双轮自平衡车是轮式机器人的一种，两轮自平衡机器人技术涉及机械、控制、力学、微电子等多个领域，本章从实际应用角度出发，阐述了两轮自平衡车的实际研究价值及广阔的研究前景。1.1两轮自平衡车的研究背景及研究意义两轮自平衡车的研究背景及研究意义21.1.1两轮自平衡车的研究背景两轮自平衡车的研究背景在私家车遍及千万家庭的当今社会，人们在面对长途旅行时可以有多样化的选择，但是中短途旅行所能做出的选择却捉襟见肘。自平衡小车以及新颖性、趣味性、便携性、实用性，正在吸引越来越多的人的关注。两轮自平衡车以其体积小、灵活度高等优势，进入市场便得到大众的青睐，众多公司中又以Segway公司的产品更为大众所认可。双轮自平衡车以其众多优势在面向以观光游览、休闲散心、购物代步为主的短途旅行成为得力的代步工具。1.1.2两轮自平衡车的研究意义两轮自平衡车的研究意义同时，两轮自平衡小车作为一种新式交通工具，以电力为能源，清洁无污染，便携体积小，对于减小工作日里的交通拥堵，减轻环境污染程度，起到建设性的作用。两轮自平衡车作为代步工具，以其便携、灵活的特点为优势，可以在人员流动量大且占地面积大的公园、商场、展览馆、游乐场等作为首选代步工具。因此具有广阔的市场前景及应用价值。两轮自平衡车以电池为能源清洁环保无污染，推广两轮自平衡小车的使用，尤其在是以中短途为主的旅行中的使用，能有效的减轻环境污染问题。两轮自平衡车系统可以抽象化一级倒立摆，因此系统本身可以作为控制策略及算法的实施验证对象，有较高的研究价值与研究意义。两轮自平衡车的一级倒立摆系统与多旋翼飞行器的运动学系统相同，因此两轮自平衡车的研究可以为日后研究多旋翼飞行器打下基础。同时两轮自平衡车系统用到的IMU（惯性测量单元）可以在多种实用、娱乐器件上应用，因此研究两轮自平衡车系统具有重要实际价值。1.2两轮自平衡车的研究现状两轮自平衡车的研究现状1.2.1两轮自平衡车的国外研究现状两轮自平衡车的国外研究现状两轮自平衡车的研究始于1987年的日本东京电信大学的山藤雄一教授1。他提出了类似两轮自平衡系统的设计思想。1995年美国人DeanKamen与他的研发公司（DEKAReasearchandDevelopmentCorp）发明了最早的双轮平衡机器人，取名Segway。7年后，Segway正式投入市场。该产品以动态稳定理论为基础，通过内置惯性测量单元，测量出驾驶者的身体重心及车体姿态，由中央微处理器发出指令驱动电机调整车体以达到动态的实现自平衡的效果。3图图1-1Segway自平衡车自平衡车同年，瑞士联邦工业大学研制出了可以对其遥控两轮自平衡机器人JOE其最大运动速度达到1.5ms。图图1-2JOE2005年日本的村田制作所在自平衡车系统的研究取得突破。此后，两轮自平衡车在控制系统与机械结构等方面都取得了长足的进步。1.2.2两轮自平衡车的国内研究现状两轮自平衡车的国内研究现状国内对自平衡机器人的研究起步较晚，但至今也取得了很大的进步。2005年，哈尔滨工业大学研制出了采用DSP作为控制核心的两轮自平衡机器人。图图1-3哈工大两轮自平衡车样机哈工大两轮自平衡车样机中国科学技术大学也研发制作了自己的两轮自平衡车，取名FreeMover。FreeMover的最高时速能够达到10kmh。由于从出现至今不过短短十年时间，两轮自平衡车现今仍不能作为一种新型交通方式。现在市面上只有Segway公司能够生产满足大众使用需求的产品。值得指出的是2008年的北京奥运会上Segway公司的产品得到了露脸的机会在奥运会上执行安保任务的4特警使用的就是Segway公司的产品。图图1-4奥运会安保特警使用奥运会安保特警使用Segway自平衡车自平衡车1.3本课题的研究内容及目标本课题的研究内容及目标鉴于两轮自平衡小车设计制作的综合性，比较适合本科阶段的毕业设计论文。与此同时，市面上的两轮自平衡车价格高昂，因此设计一个性能良好的小型样机是非常有必要的。本文提出的两轮自平衡车的亮点在于电源模块、控制器模块、通信模块、电机驱动模块多采用贴片封装，能够最大限度的降低杂生电容和杂生电感对惯性测量单元的干扰。本设计采用CortexM3内核的STM32F103系列嵌入型芯片作为主控器，性能稳定。惯性测量单元采用MPU6050芯片，包含三轴加速度计和三轴陀螺仪，其中加速度计用以测量车体的角度，陀螺仪用以测量车体的角速度。对信号采集后的滤波和姿态解算采用了两种滤波算法作为比较，分别是四元数法和卡尔曼滤波算法。电源部分采用开关型芯片LM2596提供直流电机驱动电源及AMS1117提供芯片电源，采用光耦开关TLP521与电机驱动芯片L298P结合，通过PID控制算法控制电机，最终使两轮自平衡小车这个动态不稳定系统实现最终的“自平衡”。2自平衡系统的分析自平衡系统的分析2.1控制目标控制目标由对自平衡小车的客观需要可知，两轮自平衡小车最终要实现的功能有三种，分别是保持直立、速度变化、和方向控制。其中保持直立即平衡控制是另外两个功能实现的5基础。我们可以把小车车体（姿态）作为控制对象，把两个电机作为执行机构，把两个轮子各自的转速作为控制系统的输入量。则控制系统又可进一步分为三个子系统：平衡控制系统：把小车的倾角作为输入量，通过控制两路电机的正反转来实现保持平衡。速度控制系统：在平衡控制的基础上，通过调节车体的倾角实现对小车速度的控制，其实质仍是通过控制电机转速实现车轮速度的控制。方向控制系统：控制两个电机的转速使其不同以实现车体的转向。自平衡小车的平衡控制和方向控制都是通过直接控制小车的两个电机实现的。在实际的控制中，平衡控制与方向控制的信号叠加在一起加载到电机上，因此只要电机处于正常工作的线性状态就可以同时完成这两个功能。而自平衡小车的速度是通过调节车体的倾角实现的，车体的倾角不同则速度不同即小车会有加减速现象，从而实现小车的速度控制。由控制理论可知三个分解后的子系统的控制对象相同，因此他们之间存在系统耦合。为便于分析，在分析一个子系统时，假设另外两个控制对象已经达到稳定状态。譬如，在平衡控制时，假设速度和方向控制实现平稳；同样，在速度控制时，假设已经可以保持平衡状态。在三个子系统中以平衡控制系统最为关键。但从车体平衡控制的角度来看，另外两个控制成为它的干扰。因而自平衡小车的方向和速度的控制应尽可能的保持平滑，以减少对平衡控制系统的干扰。以小车的速度控制为例，需要通过改变车体倾角的设定值来改变车体的实际倾角，达到速度控制的要求。同时，为了不对车体的平衡控制造成干扰，车体倾角的变化应该非常缓慢的进行。三者之间的配合如图2-1所示。图图2-1三层控制之间的配合三层控制之间的配合2.2自平衡系统的控制学原理分析自平衡系统的控制学原理分析2.2.1自平衡小车平衡原理解析自平衡小车平衡原理解析为了对自平衡小车的平衡控制有一个直观的感觉，首先来回顾我们在日常生活中的经验。6图图2-2保持木棒直立的反馈控制保持木棒直立的反馈控制为使木棒在手指保持直立而不倒需要两个器官可以灵活移动的手指和观察倾斜的眼睛。自平衡小车的控制也需要负反馈机制。前进后仰（a）后退纠正后仰（b）后退前倾（c）前进纠正前倾（d）图图2-3车体姿态调整分析图车体姿态调整分析图为了实现上图中所示的小车的位姿调整，需要惯性测量单元对车体倾斜角度进行实7时检测，通过控制车轮的转动抵消倾斜力矩以保持车体平衡2。2.2.2自平衡小车的运动学模型分析自平衡小车的运动学模型分析从上一小节的分析我们可以引出这样一个问题：车轮如何运行，才能保持车体平衡稳定？为了回答这个问题，可以通过建立车体的运动学和动力学数学模型，设计反馈控制来保证车体的平衡。首先我们通过与单摆模型的对比说明自平衡小车平衡的控制规律。理想化的单摆模型如下图：l图图2-4单摆模型单摆模型对单摆模型进行受力分析如下图所示：sinl=sin图图2-5单摆受力分析单摆受力分析由受力分析可知，当物体离开垂直的平衡之后，将会受到重力与悬线的作用合力，驱动物体回复到平衡位置。我们不妨称这个力为回复力。3=sin在值很小的情况下，回复力与偏移角之间可以看作正比关系，但方向相反。即。受到这个回复力的作用，单摆会作周期性运动。又由于受到空气的阻尼力，单摆最终还是会停止在平衡位置。由单摆运动产生的空气阻尼力与单摆的运动速度成正比，但方向相反。阻尼系数越大，单摆会越快停止摆动回复平衡。总结后发现有两个让单摆能够稳定在垂直位置的条件：1受到回复力的作用且回复力方向与便宜方向相反；82受到阻尼力的作用且阻尼力方向与运动速度方向相反。阻尼力在此起到很重要的作用。可以联想控制系统中的系统阻尼。同样，在实际的单摆系统中，如果没有空气的阻尼力，则单摆会在平衡位置左右晃动而无法停止；如果空气的阻尼力过小（类比欠阻尼系统），则单摆会在平衡位置震荡；如果空气的阻尼力过大（类比过阻尼系统），则单摆回复平衡位置的时间会加长。因此存在一个合适的阻尼系数，使单摆能够回复至平衡位置且所需时间最短，称这个阻尼系数为临界阻尼系数。对单摆模型分析完毕后接下来进一步对一级倒立摆模型进行建模及分析。为了便于分析，在建模过程中不考虑车轮与地面的滚动摩擦力。sin图图2-6一级倒立摆模型受力分析一级倒立摆模型受力分析由对静止一级倒立摆模型受力分析可知，其回复力为3：=sin可知，倒立摆之所以不能向单摆一样可以稳定在垂直位置，就是因为在其偏移平衡位置时受到的回复力与其偏移方向相同而不是相反，因此不满足稳定在垂直位置的条件，反而会加速偏离垂直位置直至倾倒。因此，为了满足回复力方向与运动方向相反的要求，实际可行的一种方法是驱动倒立摆底部的车轮做加速运动，假设车轮加速度为a则由牛顿第一定律及第二定律可知，倒立摆所受惯性力与重力分量的合力即为其回复力：=sincos1式中，由于很小，可以进行线性化。且假设车轮的加速度a与偏移角成正比，。则当时即可满足回复力方向与运动方向相反的要求。=11与此同时，对比上述单摆模型可知，为使一级倒立摆模型尽可能块的回复平衡位置还应该给系统增加阻尼力。虽然车体与地面及空气存在摩擦力等阻尼力但是相对较小，因此需要额外增添加阻尼力。阻尼力与运动速度即角速度成正比，方向相反。因此整理后，一级倒立摆模型的回复力大小为：。=12综上，车轮所需提供的加速度为：=1+2式中，为车体倾角，为倾角速度，、为比例系数。只有当时，倒立摆121才能满足回复至平衡位置的条件。为阻尼系数，合适的阻尼系数可以加快倒立摆回复稳2定。9cossin图图2-7在车轮上的参照系中车模受力分析在车轮上的参照系中车模受力分析2.2.3自平衡小车的数学建模自平衡小车的数学建模在以上的分析中，通过类比倒立摆得到了车体平衡控制的方案。接下来对车体进行简单的数学建模，通过基本控制理论讨论通过闭环控制实现车体保持平衡的方案。将车体模型简化成高度为L，质量为m的简单倒立摆，且置于可以左右移动的车轮上。假设外力干扰使车体产生的角加速度为x(t)，对车体进行受力分析可得自平衡车的运动方程。la(t)图图2-8外力干扰条件下的车体受力外力干扰条件下的车体受力车体运动方程3：(2-1)2()2=sin()()cos()+()在角度很小时，运动方程简化为：(2-2)2()2=()()+()车体静止时：(2-3)2()2=()+()补充：圆周运动的切向加速度=lim0=式中为圆周运动的角加速度。1021Lsg将式2-3经拉式变换转化到复平面，可以得到车体静止时的系统方程为：(2-4)2()=()+()对应车体静止时，系统输入输出的传递函数为：(2-5)()=()()=2=12可知，系统有两个极点.，且有一个极点位于右半平面。由奈奎斯特稳定=判据可知，当车体静止时系统不稳定。由上一小节对小车的运动学分析可知，车体能够回复至平衡位置的额外条件是车轮提供加速度，即相当于在系统中引入比例和微分负反馈。车体引入比例微=1+2分反馈后的系统为下图所示：Xss图图2-9加入比例微分反馈后的系统结构图加入比例微分反馈后的系统结构图2此时系统的传递函数为：，系统两个极点位于()=()()=12+2+1，由奈氏判据可知，若使系统保持稳定，需要满足=2224(1)2。因此可以得出结论，当时两轮小车可以稳定。120120在反馈环节中，由对比，可知是的微分，因而称与()=1+2=1+2角速度成比例的控制量为微分控制，称为微分微分控制参数；称与角度成比例的控制量2为比例控制，称为比例控制参数。又由对小车的运动学分析可知，微分控制参数相当于1系统的阻尼力，能起到抑制小车系统震荡的作用。在实际编写程序时将用到式2-2来改变驱动直流电机的PWM占空比。PWM=+_L12kks11式中PWM为驱动电机的PID输出量，为比例系数，为微分系数。为车体倾角值，为车体角速度值2。_本章小结：从运动学及控制学两方面分析了两轮小车保持自平衡所学要的条件，并且进行了论证。找到了实现车体保持平衡的方案。3系统硬件组成系统硬件组成3.1惯性测量单元惯性测量单元3.1.1MPU6050芯片介绍芯片介绍MPU6050是由InevenSense公司生产的全球首例整合性6轴运动处理组件，相较于多组件方案，免除了组合陀螺仪与加速器时之轴间差的问题，减少了大量的包装空间。MPU6050内部嵌入三轴加速度计、三轴陀螺仪和一个数字式运动处理硬件加速引擎能为第三方数字传感器提供I2C总线接口。MPU6050输出16位的加速度计数据和16位的陀螺仪数据。6图图3-1MPU6050芯片引脚图芯片引脚图MPU6050的内置数字式运动处理引擎提供三维运动处理和姿态检测算法。直接输出四元数。MPU6050能在用户定义的数据采集频率下收集加速度计和陀螺仪的数据。3.1.2MPU6050数据处理数据处理在处理加速度计和陀螺仪用到的方法都是比较简单的，这里的简单并不是不需要任何基础知识，只是这些基本知识都是最基本的，比如简单的三角函数，数学计算，物理知识。121.加速度和陀螺仪原理当然，在开始之前需要知道什么是加速度计，什么是陀螺仪。简单的说，加速度计主要是测量物体运动的加速度，陀螺仪主要测量物体转动的角速度。2.加速度测量我们都知道加速度具有合成定理。简单来说就是重力加速度可以理解成是由xyz三个方向的加速度共同作用的结果。反过来说就是重力加速度可以分解成xyz三个方向的加速度。加速度计可以测量某一时刻xyz三个方向的加速度值。而两轮自平衡小车利用加速度计测出重力加速度在xyz轴的分量，然后利用各个方向的分量与重力加速度的比值来计算出小车大致的倾角。其实在自平衡小车上非静止的时候，加速度计测出的结果并不是非常精确。根据高中物理学过的知识，物体时刻都会受到地球的万有引力作用产生一个向下的重力加速度。而小车在动态时，受电机的作用一定会有一个前进或者后退方向的作用力，而加速度计测出的结果是重力加速度与小车运动加速度合成得到一个总的加速度在三个方向上的分量。不过为便于分析，暂时不考虑电机作用产生的运动加速度对测量结果的影响。下边开始分析从加速度得到角度的方法。如下图，把加速度计平放，分别画出x、y、z轴的方向。这三个轴就是我们接下来分析所要用到的坐标系。图图3-2空间直角坐标系空间直角坐标系把MPU6050安装在自平衡车上时也是这样的水平安装在小车底盘上的，假设两个车轮安装时车轴和y轴在一条直线上。那么小车摆动时，参考水平面就是桌面，并且车轴（y轴）与桌面始终是平行的，小车摆动和移动过程中y轴与桌面的夹角是不会发生变化的，一直是0度。发生变化的是x轴与桌面的夹角以及z轴与桌面的夹角，而且桌面与x轴z轴夹角变化度数是一样的。所以我们只需要计算出x轴和z轴中任意一个轴的夹角就可以反映出小车的倾斜的情况了。13图图3-3以平衡车底盘平面为参考水平面以平衡车底盘平面为参考水平面为了方便分析，由于y轴与桌面夹角始终不变，我们从y轴的方向俯看下去，那么这个问题就会简化成只有x轴和z轴的二维关系。假设某一时刻小车上加速度计（MPU6050）处于如下状态，下图是我们看到简化后的模型。图图3-4车体运动倾斜车体运动倾斜在这个图中，y轴已经简化和