毕业论文两轮自平衡车平衡控制系统的研究.doc
《毕业论文两轮自平衡车平衡控制系统的研究.doc》由会员分享，可在线阅读，更多相关《毕业论文两轮自平衡车平衡控制系统的研究.doc（45页珍藏版）》请在冰点文库上搜索。
…………………….……………….…………………
毕业论文
两轮自平衡车平衡控制系统的研究
院部机械与电子工程学院
专业班级电气工程及其自动化2班
届次2015届
学生姓名
副教授
二О一五年六月六日
装
订
线
……………….…….………….………….………
38
目录
摘要 I
ABSTRAT II
引言 1
1绪论 1
1.1两轮自平衡车的研究背景及研究意义 1
1.1.1两轮自平衡车的研究背景 1
1.1.2两轮自平衡车的研究意义 2
1.2两轮自平衡车的研究现状 2
1.2.1两轮自平衡车的国外研究现状 2
1.2.2两轮自平衡车的国内研究现状 3
1.3本课题的研究内容及目标 4
2自平衡系统的分析 4
2.1控制目标 4
2.2自平衡系统的控制学原理分析 5
2.2.1自平衡小车平衡原理解析 5
2.2.2自平衡小车的运动学模型分析 7
2.2.3自平衡小车的数学建模 9
3系统硬件组成 11
3.1惯性测量单元 11
3.1.1MPU6050芯片介绍 11
3.1.2MPU6050数据处理 12
3.1.3数据滤波算法 16
3.1.4MPU6050驱动电路 20
3.2主控单元 20
3.3电源模块 21
3.3.1LM2596芯片介绍 21
3.3.2AMS1117芯片介绍 22
3.4电机驱动模块 23
3.5编码器模块 24
4系统程序及算法 25
4.1MPU6050获取数据 25
4.1.1MPU6050初始化 26
4.1.2主函数中的姿态数据处理 26
5两轮自平衡车平衡控制的总结 35
5.1设计的主要内容 35
5.2设计的不足 36
参考文献 37
致谢 38
CONTENTS
ABSTRACT II
INTRODUCTION 1
1EXORDIUM 1
1.1THEBACKGROUNDOFSELF-BALANCEDCAR 1
1.1.1THEBACKGROUND 1
1.1.2RESEARCHMEANINGOFSELF-BALANCECAR 2
1.2THEPRESENTSITUATIONOFRESEARCHOFSELF-BALANCE 2
1.2.1INTERNETIONALSITUATION 2
1.2.2THERESEARCHSITUATIONOFCHINA 3
1.3GOALOFTHISRESEARCH 4
2ANALYSISOFSELF-BALANCESYSTEM 4
2.1THEPURPOSEOFCONTROLSYSTEM 4
2.2CONTROLSCIENCEANALYSIS 5
2.2.1BALANCETHEORYOFSELF-BALANCEDCAR 5
2.2.2KINESIOLOGYMODELANALYSIS 7
2.2.3MATHEMATICALMODELING 9
3HARDWARECOMPONENT 11
3.1INERTIALMEASURMENTUINT 11
3.1.1MPU6050INTRODUCTION 11
3.1.2DATEPROCESSINGOFMPU6050 12
3.1.3ALGORITHMOFDATAFILTER 16
3.1.4DRIVECIRCUITOFMPU6050 20
3.2MAINCONTROLUNIT 20
3.3POWERUNIT 21
3.3.1INTRODUCTIONOFLM2596 21
3.3.2INTRODUCTIONOFAMS1117 22
3.4MOTORDRIVERUNIT 23
3.5ENCODERUNIT 24
4PROGRAMANDALGORITHM 25
4.1MPU6050GETDATA 25
4.1.1INITIALOFMPU6050 26
4.1.2PROCESSINGGESTUREDATAINMAINFUNCTIONG 26
5SUMMARIZEOFBALANCECONTROLINGOFSELF-BALANCECAR 35
5.1MAINSUBSTANCEOFTHISPROJECT 35
5.2BLEMISHOFTHISPROJECT 36
REFERENCEDOCUMENTATION 37
THANKS 38
两轮自平衡车平衡控制系统的研究
王恒
（山东农业大学机械与电子工程学院泰安271018）
摘要：
自从在2008年北京奥运会上的精彩亮相，两轮自平衡车在中国市场已经逐渐为大众所接受。
节能环保、便携新颖，两轮自平衡车以其独特的优势博取人们的青睐。
又两轮自平衡小车以其一级倒立摆结构成为控制算法验证实现的独特平台。
因此，两轮自平衡小车有较高的研究价值。
本设计的重点是抓住两轮自平衡车的基础即平衡控制进行系统设计，结合姿态解算数据融合算法驱动直流电机以实现两轮小车的平衡控制。
关键词：
自平衡姿态解算数据滤波倒立摆Theresearchofself-balancedcarcontrolsystem
HengWang
（Mechanical&ElectricalEngineeringCollegeofShandongAgriculturalUniversity,Tai’an,Shandong271018）
AbstractSincethefirstappearanceatthe2008BeijingOlympicCompetition,two-wheelbalancedcarhasbeenacceptedbymoreandmorepeople.Thetwo-wheelbalancedcarhastakenplaceofmanypeople’sheartbecauseofitsspecialcharacteristicjustasenvironmentalprotectionandeasy-taken.Thetwo-wheelself-balancedcarhasalsobecomeauniqueplatformofcontrollingalgorithmbecauseofitssingleinverted-pendulumstructure.Sothetwo-wheelself-balancedcarhasahighvaluetobestudied.Thisdesignationwasbasedonthebasisoftwo-wheelbalancedcarandthatisbalanced-control,usingInertialmeasurementunittodetectthegestureofthecarandtacklethedatawithKalmanfilter,drivingthemotorwiththePIDcontroller.
Keywords:
self-balanced;destureanalysis;singledatafilter;invertedpendulumstructure
引言
新型交通方式越来越吸引人们的注意，北京奥运会上双轮自平衡车的亮相让人们眼前一亮。
以电池作能源，清洁无污染，便携、灵活、新颖等优势使自平衡车迅速博得消费者的青睐。
移动机器人是机器人学的一个重要分支，对于移动机器人的研究，包括轮式、腿式、履带式以及水下式机器人等，可以追溯到20世纪60年代。
移动机器人得到快速发展有两方面原因：
一是其应用范围越来越广泛；二是相关领域如计算、传感、控制及执行等技术的快速发展。
移动机器人尚有不少技术问题有待解决，因此近几年对移动机器人的研究相当活跃。
近年来，随着移动机器人研究不断深入、应用领域更加广泛，所面临的环境和任务也越来越复杂。
机器人经常会遇到一些比较狭窄，而且有很多大转角的工作场合，如何在这样比较复杂的环境中灵活快捷的执行任务，成为人们颇为关心的一个问题。
双轮自平衡机器人概念就是在这样的背景下提出来的。
两轮自平衡小车是一个高度不稳定两轮机器人，是一种多变量、非线性、强耦合的系统，是检验各种控制方法的典型装置。
同时由于它具有体积小、运动灵活、零转弯半径等特点，将会在军用和民用领域有着广泛的应用前景。
因为它既有理论研究意义又有实用价值，所以两轮自平衡小车的研究在最近十年引起了大量机器人技术实验室的广泛关注。
由于特殊的两轮结构，自平衡小车本身就是一个不稳定系统。
如何让双轮小车在保持稳定的基础上实现前后行驶以及自由转向，成为一个技术上的问题。
解决这一问题，将要用到机械设计和自动化专业的知识，涉及电子、机械、运动学、控制学等多学科知识。
双轮自平衡车系统可进一步抽象化为一级倒立摆结构。
经过对一级倒立摆结构的数学建模和运动学分析，结合控制学原理，可以得出使双轮自平衡车保持动态稳定的几个条件。
（详见第二章自平衡系统的分析）
双轮自平衡车平衡控制系统以STM32F103C8T6芯片作为主控芯片运用姿态传感器MPU6050，结合数据滤波算法进行数据融合，建立闭环控制系统驱动直流电机。
再用编码器实时监测电机转速以反馈给主控系统，形成一个小闭环。
最终能够实现双轮自平衡车的平衡控制。
（详见第三章系统硬件组成）
1绪论
双轮自平衡车是轮式机器人的一种，两轮自平衡机器人技术涉及机械、控制、力学、微电子等多个领域，本章从实际应用角度出发，阐述了两轮自平衡车的实际研究价值及广阔的研究前景。
1.1两轮自平衡车的研究背景及研究意义
1.1.1两轮自平衡车的研究背景
在私家车遍及千万家庭的当今社会，人们在面对长途旅行时可以有多样化的选择，但是中短途旅行所能做出的选择却捉襟见肘。
自平衡小车以及新颖性、趣味性、便携性、实用性，正在吸引越来越多的人的关注。
两轮自平衡车以其体积小、灵活度高等优势，进入市场便得到大众的青睐，众多公司中又以Segway公司的产品更为大众所认可。
双轮自平衡车以其众多优势在面向以观光游览、休闲散心、购物代步为主的短途旅行成为得力的代步工具。
1.1.2两轮自平衡车的研究意义
同时，两轮自平衡小车作为一种新式交通工具，以电力为能源，清洁无污染，便携体积小，对于减小工作日里的交通拥堵，减轻环境污染程度，起到建设性的作用。
①两轮自平衡车作为代步工具，以其便携、灵活的特点为优势，可以在人员流动量大且占地面积大的公园、商场、展览馆、游乐场等作为首选代步工具。
因此具有广阔的市场前景及应用价值。
②两轮自平衡车以电池为能源清洁环保无污染，推广两轮自平衡小车的使用，尤其在是以中短途为主的旅行中的使用，能有效的减轻环境污染问题。
③两轮自平衡车系统可以抽象化一级倒立摆，因此系统本身可以作为控制策略及算法的实施验证对象，有较高的研究价值与研究意义。
④两轮自平衡车的一级倒立摆系统与多旋翼飞行器的运动学系统相同，因此两轮自平衡车的研究可以为日后研究多旋翼飞行器打下基础。
同时两轮自平衡车系统用到的IMU（惯性测量单元）可以在多种实用、娱乐器件上应用，因此研究两轮自平衡车系统具有重要实际价值。
1.2两轮自平衡车的研究现状
1.2.1两轮自平衡车的国外研究现状
两轮自平衡车的研究始于1987年的日本东京电信大学的山藤雄一教授[1]。
他提出了类似两轮自平衡系统的设计思想。
1995年美国人DeanKamen与他的研发公司（DEKAReasearchandDevelopmentCorp）发明了最早的双轮平衡机器人，取名Segway。
7年后，Segway正式投入市场。
该产品以动态稳定理论为基础，通过内置惯性测量单元，测量出驾驶者的身体重心及车体姿态，由中央微处理器发出指令驱动电机调整车体以达到动态的实现自平衡的效果。
图1-1Segway自平衡车
同年，瑞士联邦工业大学研制出了可以对其遥控两轮自平衡机器人JOE,其最大运动速度达到1.5m/s。
图1-2JOE
2005年日本的村田制作所在自平衡车系统的研究取得突破。
此后，两轮自平衡车在控制系统与机械结构等方面都取得了长足的进步。
1.2.2两轮自平衡车的国内研究现状
国内对自平衡机器人的研究起步较晚，但至今也取得了很大的进步。
2005年，哈尔滨工业大学研制出了采用DSP作为控制核心的两轮自平衡机器人。
图1-3哈工大两轮自平衡车样机
中国科学技术大学也研发制作了自己的两轮自平衡车，取名FreeMover。
FreeMover的最高时速能够达到10km/h。
由于从出现至今不过短短十年时间，两轮自平衡车现今仍不能作为一种新型交通方式。
现在市面上只有Segway公司能够生产满足大众使用需求的产品。
值得指出的是2008年的北京奥运会上Segway公司的产品得到了露脸的机会——在奥运会上执行安保任务的特警使用的就是Segway公司的产品。
图1-4奥运会安保特警使用Segway自平衡车
1.3本课题的研究内容及目标
鉴于两轮自平衡小车设计制作的综合性，比较适合本科阶段的毕业设计论文。
与此同时，市面上的两轮自平衡车价格高昂，因此设计一个性能良好的小型样机是非常有必要的。
本文提出的两轮自平衡车的亮点在于电源模块、控制器模块、通信模块、电机驱动模块多采用贴片封装，能够最大限度的降低杂生电容和杂生电感对惯性测量单元的干扰。
①本设计采用CortexM3内核的STM32F103系列嵌入型芯片作为主控器，性能稳定。
②惯性测量单元采用MPU6050芯片，包含三轴加速度计和三轴陀螺仪，其中加速度计用以测量车体的角度，陀螺仪用以测量车体的角速度。
③对信号采集后的滤波和姿态解算采用了两种滤波算法作为比较，分别是四元数法和卡尔曼滤波算法。
④电源部分采用开关型芯片LM2596提供直流电机驱动电源及AMS1117提供芯片电源，采用光耦开关TLP521与电机驱动芯片L298P结合，通过PID控制算法控制电机，最终使两轮自平衡小车这个动态不稳定系统实现最终的“自平衡”。
2自平衡系统的分析
2.1控制目标
由对自平衡小车的客观需要可知，两轮自平衡小车最终要实现的功能有三种，分别是保持直立、速度变化、和方向控制。
其中保持直立即平衡控制是另外两个功能实现的基础。
我们可以把小车车体（姿态）作为控制对象，把两个电机作为执行机构，把两个轮子各自的转速作为控制系统的输入量。
则控制系统又可进一步分为三个子系统：
①平衡控制系统：
把小车的倾角作为输入量，通过控制两路电机的正反转来实现保持平衡。
②速度控制系统：
在平衡控制的基础上，通过调节车体的倾角实现对小车速度的控制，其实质仍是通过控制电机转速实现车轮速度的控制。
③方向控制系统：
控制两个电机的转速使其不同以实现车体的转向。
自平衡小车的平衡控制和方向控制都是通过直接控制小车的两个电机实现的。
在实际的控制中，平衡控制与方向控制的信号叠加在一起加载到电机上，因此只要电机处于正常工作的线性状态就可以同时完成这两个功能。
而自平衡小车的速度是通过调节车体的倾角实现的，车体的倾角不同则速度不同即小车会有加减速现象，从而实现小车的速度控制。
由控制理论可知三个分解后的子系统的控制对象相同，因此他们之间存在系统耦合。
为便于分析，在分析一个子系统时，假设另外两个控制对象已经达到稳定状态。
譬如，在平衡控制时，假设速度和方向控制实现平稳；同样，在速度控制时，假设已经可以保持平衡状态。
在三个子系统中以平衡控制系统最为关键。
但从车体平衡控制的角度来看，另外两个控制成为它的干扰。
因而自平衡小车的方向和速度的控制应尽可能的保持平滑，以减少对平衡控制系统的干扰。
以小车的速度控制为例，需要通过改变车体倾角的设定值来改变车体的实际倾角，达到速度控制的要求。
同时，为了不对车体的平衡控制造成干扰，车体倾角的变化应该非常缓慢的进行。
三者之间的配合如图2-1所示。
图2-1三层控制之间的配合
2.2自平衡系统的控制学原理分析
2.2.1自平衡小车平衡原理解析
为了对自平衡小车的平衡控制有一个直观的感觉，首先来回顾我们在日常生活中的经验。
图2-2保持木棒直立的反馈控制
为使木棒在手指保持直立而不倒需要两个器官——可以灵活移动的手指和观察倾斜的眼睛。
自平衡小车的控制也需要负反馈机制。
前进后仰
（a）
后退纠正后仰
（b）
后退前倾
（c）
前进纠正前倾
（d）
图2-3车体姿态调整分析图
为了实现上图中所示的小车的位姿调整，需要惯性测量单元对车体倾斜角度进行实时检测，通过控制车轮的转动抵消倾斜力矩以保持车体平衡[2]。
2.2.2自平衡小车的运动学模型分析
从上一小节的分析我们可以引出这样一个问题：
车轮如何运行，才能保持车体平衡稳定？
为了回答这个问题，可以通过建立车体的运动学和动力学数学模型，设计反馈控制来保证车体的平衡。
首先我们通过与单摆模型的对比说明自平衡小车平衡的控制规律。
理想化的单摆模型如下图：
l
θ
图2-4单摆模型
对单摆模型进行受力分析如下图所示：
θ
l
图2-5单摆受力分析
由受力分析可知，当物体离开垂直的平衡之后，将会受到重力与悬线的作用合力，驱动物体回复到平衡位置。
我们不妨称这个力为回复力。
[3]
在值很小的情况下，回复力与偏移角之间可以看作正比关系，但方向相反。
即。
受到这个回复力的作用，单摆会作周期性运动。
又由于受到空气的阻尼力，单摆最终还是会停止在平衡位置。
由单摆运动产生的空气阻尼力与单摆的运动速度成正比，但方向相反。
阻尼系数越大，单摆会越快停止摆动回复平衡。
总结后发现有两个让单摆能够稳定在垂直位置的条件：
⑴受到回复力的作用且回复力方向与便宜方向相反；
⑵受到阻尼力的作用且阻尼力方向与运动速度方向相反。
阻尼力在此起到很重要的作用。
可以联想控制系统中的系统阻尼。
同样，在实际的单摆系统中，如果没有空气的阻尼力，则单摆会在平衡位置左右晃动而无法停止；如果空气的阻尼力过小（类比欠阻尼系统），则单摆会在平衡位置震荡；如果空气的阻尼力过大（类比过阻尼系统），则单摆回复平衡位置的时间会加长。
因此存在一个合适的阻尼系数，使单摆能够回复至平衡位置且所需时间最短，称这个阻尼系数为临界阻尼系数。
对单摆模型分析完毕后接下来进一步对一级倒立摆模型进行建模及分析。
为了便于分析，在建模过程中不考虑车轮与地面的滚动摩擦力。
图2-6一级倒立摆模型受力分析
由对静止一级倒立摆模型受力分析可知，其回复力为[3]：
可知，倒立摆之所以不能向单摆一样可以稳定在垂直位置，就是因为在其偏移平衡位置时受到的回复力与其偏移方向相同而不是相反，因此不满足稳定在垂直位置的条件，反而会加速偏离垂直位置直至倾倒。
因此，为了满足回复力方向与运动方向相反的要求，实际可行的一种方法是驱动倒立摆底部的车轮做加速运动，假设车轮加速度为a,则由牛顿第一定律及第二定律可知，倒立摆所受惯性力与重力分量的合力即为其回复力：
式中，由于很小，可以进行线性化。
且假设车轮的加速度a与偏移角成正比，。
则当时即可满足回复力方向与运动方向相反的要求。
与此同时，对比上述单摆模型可知，为使一级倒立摆模型尽可能块的回复平衡位置还应该给系统增加阻尼力。
虽然车体与地面及空气存在摩擦力等阻尼力但是相对较小，因此需要额外增添加阻尼力。
阻尼力与运动速度即角速度成正比，方向相反。
因此整理后，一级倒立摆模型的回复力大小为：
。
综上，车轮所需提供的加速度为：
式中，为车体倾角，为倾角速度，、为比例系数。
只有当时，倒立摆才能满足回复至平衡位置的条件。
为阻尼系数，合适的阻尼系数可以加快倒立摆回复稳定。
升级会员 