机器人,设计,论文,平衡分析解析

1、分类号密级UDC编号本科毕业论文（设计）题目单轴双轮自平衡机器人的设计与制作系别专业名称电子信息科学与技术年级学生姓名学号指导教师二0一六年四月1. 绪论错误！未定义书签。1.1 引言错误！未定义书签。1.2 本文研究的内容错误！未定义书签。2. 理论分析错误！未定义书签。2.1 自平衡小车的物理建模错误！未定义书签。2.2 PID控制技术错误！未定义书签。2.3 简易对称互补滤波技术错误！未定义书签。3. 系统设计错误！未定义书签。3.1 硬件设计方案论证错误！未定义书签。3.2 软件设计方案论证错误！未定义书签。4. 综合调试错误！未定义书签。5. 总结错误！未定义书签。参考文献错误！未定

2、义书签。附录部分程序代码错误！未定义书签。摘要：单轴双轮自平衡机器人是一个极不稳定的系统，常用来检验控制算法的有效性。本文主要综述了单轴双轮自平衡系统的研究现状，以及单轴双轮自平衡系统的研究价值。然后通过物理建模得到了单轴双轮自平衡系统的运动学特性，并结合传感器技术和自动控制理论提出了一个单轴双轮自平衡小车的设计方案。采用了陀螺仪和加速度传感器分别对车体倾角进行检测，利用对称互补滤波算法对检测到的数据进行融合得到精确的车体倾角，再引入PID技术对车体姿态进行精确控制。最后对论文所做的工作进行了总结，对未来的研究和发展做出了展望。关键词：自平衡电机驱动PID技术陀螺仪简易对称互补滤波器Abstr

3、act:Theuniaxialtwo-wheeledself-balancingrobotisaveryunstablesystem,sooftenusedtotesttheeffectivenessofthecontrolalgorithm.Inrecentyearsmanyexpertsfromhomeandabroadhavehadadeepresearchonthetheoryofuniaxialtwo-wheeledself-balancing,andthetheorywasgreatlypromoted.Thenthroughthephysicalmodelingthekinema

4、ticcharacteristicswasfound,andCombinedwithsensortechnologyandautomaticcontroltheoryadesignwasPresented.Thegyroscopeandaccelerometersensorsarerespectivelyonrobotinclinationdetection,complementarysymmetryfilteringalgorithmwasusedtodealwithdataandgettheprecisebodyinclination,ThenintroducePIDtechnologyo

5、nvehicleattitudecontrol.Finallythepapermakesaconclusion,implicationsforfutureresearchanddevelopmentprospects.Keywords:self-balancemotor-drivesPIDtechnologygyroscopesimplecomplementaryfiltering1 .绪论1.1 引言近年来，随着人工智能理论和传感器技术的发展，机器人理论得到了很大的发展。做为移动机器人中的一个重要分支，单轴双轮自平衡系统也引起了国内外的科研机构和企业以及一些机器人DIY爱好者的关注。它是一个

6、绝对不稳定系统，必须施加强有力的控制手段才能保重其平衡，所以它可以用于检验控制算法的有效性。由于引入了人工智能技术和传感器技术所以可以完成复杂环境下的复杂任务，只需要在硬件上做很少的改动就可以增加载人功能，成为单轴双轮自平衡代步车。2002年瑞士联邦技术学院工业电子实验室的研究人员研制的名为JOE的基于倒立摆的小型自平衡两轮车模型，是由DSP芯片进行控制的。它由车架上方所附的重物模拟实际车中的驾驶者。研究人员通过陀螺仪和光电编码器测量的数据，用线性状态反馈控制器控制整个系统的平衡稳定1。同年，美国kgo公司的SteveHassenplug设计了两轮自平衡传感式机器人Lcgway。这个设计引入了

7、电机的差动驱动方式，它可以工作在倾斜面甚至不规则表面上，可遥控操作。通过对电动机进行遥控，Legway可以在前行，后退和转弯时保持平衡，可以实现零半径转弯和U型回转。同年三洋电机展示了可依靠上体倒立来保持平衡的双轮行走机器人"FLATHRU”，大小为602X463X564mm,重20Kg。移动速度方面，平地行走时最大30cm/s,可搬运重量最大为10Kg,运行时间约为1小时。车轮中嵌有一个输出功率为90W的直流电动机，头部则嵌入了两个相同的电动机。为了检测上体的平衡情况，使用了3个陀螺仪和1个3轴加速度传感器。同年，美国Segway公司开发了世界上第一部能够自平衡的两轮电动车，时速高

8、达20Km/h。该电动车把人们从传统的“三点平衡”和以低重心、大而稳的底盘设计来避免倾斜的束缚中解脱出来。通过检测车体的角度和角速度，用适当的回复转矩来避免倾斜摔倒。Segway使用的是航空级陀螺仪、一组倾斜传感器、一套复杂的“直觉软件”、一个加速度计、十个微处理器、两个镍氢电池组、一台电动机和每秒检测一百多次驾驶者重心的传感器。2007年，日本早稻田大学的RyoWatanabe在Legway的启发下设计制作了NXTway,美国麻省理工学院的几名学生设计制作出了一台自平衡小车，中心处理器采用PIC单片机2。以上是国内外两轮自平衡机器人和自平衡代步车的研究现状。这些机器人和代步车对本课题的研究提

9、供了很好的指导作用。为下面的研究工作提供了很好的分参考。1.2 本文研究的主要内容本文研究主要的内容包括：1）双轮自平衡机器人的物理建模；2）对几种常用的直流有刷电机驱动电路进行分析对比，选取一款合适的电机驱动电路；3）对几种常用的测量电机转速的方法进行分析和对比，选取一种合理的测量电机转速的方案；4）仔细研究系统中使用的多个不同电压值的电源，对常用的稳压电路进行分析和对比，选取一种合适的电源方案；5）研究PID算法的基本原理，并将PID算法应用在直流有刷电机的控制中；6）对几种常用的陀螺仪和加速度计等惯性元件的性能进行分析对比，并深入研究互补对称滤波数据融合技术，选出合适的陀螺仪和加速度计；

10、7）采用AltiumDesigner软件绘制电路原理图和PCB板，搭建STM32最小硬件系统，利用RVMDKV4.2编译调试软件，以及STM32固件库完成STM32的软件开发；8）仔细研究系统中各个模块之间的通信协议以及实现方法，选取合适的通信方案。2.理论分析2.1 自平衡小车的物理建模图2-1单轴双轮自平衡机器人的受力示意图机器人受力分解图如图2-1所示。其中规定质心为O,水平方向为x垂直方向为y,机器人支架中心轴线规定为轴 m,与其垂直方向的轴线规定为n,日为机器人的偏角。机器人本质不稳定，车体倾斜的原因源于重力在水平方向的分量。为了保持平衡，机器人x方向的驱动力f必须等于或大于重力沿着

11、水平方向x轴的分力fH o当机器人实现动态平衡时，水平方向的推力fF(t)= fH (t) 3o由图2-1得，重力沿着水平方向的分量为:fH (t) = (M m)gtan 二(2-1)电机产生的水平方向的驱动力f (t)为:上 Kgf(t)=常(2-2)其中，R为车轮半径，Kg减速比，yt)电机扭矩。如果已知电机的最大扭矩，可求得单轴双轮自平衡机器人达到动态平衡时的倾角为:arctan3L_ (M m)g(2-3)将电机的最大扭矩ax代入式2-2,可以得到最大驱动力fmax,再将fmax代入式2-3可得到单轴双轮自平衡机器人的最大可控角度日maxo上面的计算是在系统没有动能损失的情况下，即小

12、车在调整平衡过程中没有运动，如果考虑这些因素，系统的控制范围要小一些，因此可以最终确定系统的控制范围为：6maxM8m.-8max22-4)55以上的物理建模完成了对单轴双轮自平衡机器人的受力分析和最大可控角度推导，旨在为PID控制提供理论指导。2.2PID控制技术PID是比例(Proportion)、积分(Integration)、微分(Differentiation)的英文缩写。PID控制技术是工程应用中最为广泛的调节器控制规律，简称PID控制或PID调节。PID控制器问世至今已有近70年历史，其结构简单、稳定性好、工作可靠、调整方便，因而成为工业控制的主要技术之一。当被控对象的结构和参数

13、不能完全掌握，或得不到精确的数学模型时，理制理论的其它技术难以采用时，系统控制器的结构和参数必须依靠经验和现场调试来确定，这时应用PID控制技术最为方便。即当我们不完全了解一个系统和被控对象，或不能通过有效的测量手段来获得系统参数时，最适合用PID控制技术。当被控对象的结构和参数不能完全掌握，或得不到精确的数学模型时，控制理论的其它技术难以采用时，系统控制器的结构和参数必须依靠经验和现场调试来确定，这时应用PID控制技术最为方便。而本系统是一个复杂的非线性系统，其约束条件不确定，很难通过物理建模直接得到系统的精确数学模型。因此本系图3-1 PID控制系统原理图如图3-1所示PID控制器就是根据

14、系统的误差，利用比例、积分、微分计算出控制量进行控制的。其中r(t)为给定值，y(t)为系统的实际输出值，给定值与实际输出值构成控制偏差e(t)e(t)=y(t)-r(t)(3-1)e(t)作为PID控制的输入，y(t)作为PID控制器的输出和被控对象的输入。所以模拟PID控制器的控制规律为：1tde什)u(t)=Kpe(t)+-e(t)dt+Td2(3-2)Ti0dt其中：Kp控制器的比例系数Ti控制器的积分时间，也称积分系数Td控制器的微分时间，也称微分系数将偏差的比例(Proportion)、积分(Integral)和微分(Differential)通过线性组合构成控制量，用这一控制量对

15、被控对象进行控制，这样的控制器称PID控制器。由于计算机的出现，计算机进入了控制领域。人们将模拟PID控制规律引入到计算机中来。对式3-2的PID控制规律进行适当的变换，就可以用软件实现PID控制，即数字PID控制。数字PID可分为：位置式PID算法和增量式PID算法。本系统是一个基于嵌入式微处理器的数字控制系统，因此引入的PID为数字式PID,再结合本系统的特性，最终选取了增量式PID算法为本系统的核心控制策略。所谓增量式PID是指数字控制器的输出只是控制量的增量iuk4o当执行机构需要的控制量是增量，而不是位置量的绝对数值时，可以使用增量式PID控制算法进行控制。增量式PID可以表达为：:

16、u"Uk-u=Kp(ek一5TQTdek-2ekr一")TiTTTd2Td、Td=Kp(1+)ek-Kp(1+)eku+Kpek(3-3)TiTTT=AekBek4Cek-2其中A=Kp(1+工+亚)；TiTB t Kp(12TdTnKpTd由式3-3可以看出，如果计算机控制系统采用恒定的采样周期T,一旦确定A、B、C,只要使用前后三次测量的偏差值，就可以由式求出控制量。增量式PID控制算法与位置式PID算法相比，计算量小的多，因此在实际中得到广泛的应用。而位置式PID控制算法也可以通过增量式控制算法推出递(3-4)推计算公式:Uk=UkUk式3-4就是目前在计算机控制中广

17、泛应用的数字递推PID控制算法。有了控制算法后最主要的就是控制器参数整定，即决定调节器的比例系数、积分时间Ti、微分时间Td和采样周期Ts的具体数值。整定的实质是通过改变调节器的参数，使其特性和过程特性相匹配，以改善系统的动态和静态指标，取得最佳的控制效果。整定调节器参数的方法很多，归纳起来可分为两大类，即理论计算整定法和工程整定法。理论计算整定法有对数频率特性法和根轨迹法等；工程整定法有凑试法、临界比例法、经验法、衰减曲线法和响应曲线法等。工程整定法特点不需要事先知道过程的数学模型，直接在过程控制系统中进行现场整定方法简单、计算简便、易于掌握。本系统的建模十分复杂，无法得出一个精确的物理模型

18、，所以在本系统的PID算法参数选取采用工程整定法。通过实验调试来不断的优化控制参数，提高单轴双轮自平衡机器人的稳定度。2.3简易对称互补滤波为进行实时控制，单轴双轮自平衡机器人系统的主控制器必须对工作环境和任务有足够的了解，这样就离不开相应的传感器。机器人姿态检测系统中通常使用的传感器为惯性传感器，本系统用到的惯性传感器有加速度传感器和陀螺仪，另外还要用到光电码盘测速模块，他们分别用于检测车身倾斜角、倾斜角速度和车体实时速度。这三种信号主要反应了机器人的位姿和运动状态。本节主要讨论如何对来自惯性传感器的数据进行融合处理，以得到最优的车体姿态信息2.3.1 加速度传感器数据处理加速度传感器可以测

19、量动态和静态的线性加速度，静态加速度的一个典型例子就是重力加速度，用加速度传感器来直接测量物体静态重力加速度可以确定倾斜角度。当加速度出于静止状态时，加速度传感器的输出为其三个敏感轴上的重力加速度分量。图3-2加速度传感器加速度分解图当我们选取加速传感器的X敏感轴作为测量主轴，如图所示，则X敏感轴上的加速度为:ax=gsin：(3-5)所以，求得车体倾角:araarcsin1ax|(3-6)g加速度计动态响应慢，不适合跟踪动态角度运动；如果期望快速的响应，又会引入较大的噪声。再加上其测量范围的限制，使得单独应用加速度计检测车体倾角并不合适，需要与其它传感器共同使用。2.3.2 陀螺仪数据处理单

20、轴双轮自平衡控制系统除了需要实时的倾角信号，还要用到角速度以给出控制量。理论上可以对加速度计测得的倾角求导得到角速度，但实际上这样求得的结果往往偏差很大。陀螺仪具有动态性能好测量精度高等优点，但是由于温度变化、摩擦力和不稳定力矩等因素，陀螺仪会产成漂移误差。两轮自平衡机器人控制系统除了需要实时的倾角信号，还要用到角速度以给出控制量。理论上可以对加速度计测得的倾角求导得到角速度，但实际上这样求得的结果远远低于陀螺仪测值的精度，陀螺仪具有动态性能好的优点。陀螺仪的直接输出值是相对灵敏轴的角速率，角速率对时间积分即可得到围绕灵敏轴旋转过的角度值。由于系统采用微控制器循环采样程序获取陀螺仪角速率信息,

21、即每隔一段很短的时间采样一次，所以采用累加的方法实现积分的功能来计算角度化anglen=anglen+gy0dt(3-7)anglen为陀螺仪采样到第n次的角度值；angle为陀螺仪第n-1次采样时的角度值；gyro为陀螺仪的第n次采样得到的瞬时角速率值；出为主循环程序运行一遍所用时间。可见，用陀螺仪输出值积分计算角度，要求处理器运算速度足够快，采样程序应尽量简练，程序循环一遍所用时间出越小，采样频率越高，最后积分得到的角度值才能越精确。陀螺仪是用来测量角速度信号的，通过对角速度积分，能得到角度值。但由于温度变化、摩擦力和不稳定力矩等因素，陀螺仪会产成漂移误差。而无论多么小的常值漂移通过积分都

22、会得到无限大的角度误差。因而，也不能单独使用陀螺仪作为本机器人倾角传感器。综上所述，对于姿态检测系统而言，单独使用陀螺仪或者加速度计，都不能提供有效而可靠的信息来保证车体的平衡。陀螺仪虽然动态性能良好，能够提供瞬间的动态角度变化，不受加速度变化的影响，但是由于其本身固有的特性、温度及积分过程的影响，存在累积漂移误差，不适合长时间单独工作；加速度计静态响应好，能够准确提供静态的角度，但受动态加速度影响较大，不适合跟踪动态角度运动。为了克服这些困难，采用一种简易互补滤波方法来融合陀螺仪和加速度计的输出信号，补偿陀螺仪的漂移误差和加速度计的动态误差，得到一个更优的倾角近似值。2.3.3 传感器数据融

23、合经过融合的多传感器系统能完善地、精确地反映检测对象特性，消除信息的不确定性，提高传感器的可靠性5。针对于陀螺仪数据噪声小，短时间内误差小，温度漂移大，积分积累误差较大的特性，加速度传感器对震动敏感，无积累误差，长时间稳定的特性。加速度传感器需要采用滤波算法滤除短时性快速变化的信号，保留长时性缓慢变化的信号，所以对加速度计应用低通滤波算法。对于陀螺仪，情况正好相反，应用高通滤波方法处理陀螺仪数据，来抑制陀螺仪积分的漂移。针对加速度计和陀螺仪的姿态检测系统滤波器结构如图3-3所示anglen=agy0°anglen,+gyrondt)+aaccega.(3-8).dt式中agyro=为

24、陀螺仪的高通滤波系数，aacce=为加速度计的低通滤dt.dt波系数。为滤波器的时间常数。对于低通滤波而言，变化周期大于时间常数的信号可以完整的通过；变化周期小于时间常数的信号被过滤掉；高通滤波刚好相反。这个时间常数，是更相信陀螺仪还是更相信加速度计的一个界限值。变化周期比施的，陀螺仪积分的角度更让人相信，而加速度计噪声被过滤掉；变化周期比上的，加速度计测定的角度值比陀螺仪更重要，因为此时陀螺仪会发生漂移了。针对陀螺仪的高通滤波和针对加速度计的低通滤波两部分恰好可组成一个互补滤波器。可以看到，两个滤波系数相加结果为1,所以滤波结果是一个比较精确的、线性的角度估计值。滤波器设计完成后，时间常数的

25、选取是十分重要的，通过对陀螺仪和加速度传感器的输出特性的分析，结合实验法选取一个合适的就完成了滤波器的设计。3 .系统设计根据以上对单轮自平衡机器人运动学特性的分析，提出三种可行性较大的实现方案：方案一：使用一个型号为STC12C5A60S2的单片机和两个型号为E18-D30NK的红外传感器实现的简易单轴双轮自平衡机器人。图3-1基于红外传感器的双轮自平衡机器人E18-D30NK红外传感器是一种开关式的红外传感器，它由一个红外的发射电路发射调制的红外光，经地面反射后进入接收光敏传感器电路，利用发射光的强度来测传感器和地面之间的距离。它测距的方式是一种比较式的测距方式，即开始通过调节电位器来为传

26、感器设定一个阈值，当传感器与地面之间的距离大于阈值时传感器输出高电平，当传感器与地面之间的距离小于阈值时传感器输出低电平。如图4-1所示，将两个E18-D30NK红外传感器装在车的两臂上，当车体向左倾斜的时候Hi小于阈值，红外传感器A将输出低电平，当主控单片机STC12C5A60S2检测到此低电平的时候会通过电机驱动电路驱动电机使车体向左运动，以维持平衡。车体向右倾斜时有类似的控制过程。方案一的优点：结构简单，成本低，控制算法也相对简单，而且可以反应单轴双轮自平衡的动力学过程。方案一的缺点：红外传感器E18-D30NK为反射式的红外传感器，测量的结果受地面的颜色、平整度等各种因素的影响。红外传

27、感器E18-D30NK为二值化得信号输出，导致在对电机的控制时无法引入PID控制技术。方案二：使用STC12C5A60S2单片机和两个超声波测距模块实现的单轴双轮自平衡机器人。图3-2基于超声波传感器的单轴双轮自平衡机器人超声波传感器由超声波的发射头和发射电路以及接收头和接受电路构成，超声波传感器的测距原理是声波在均匀的介质中的传播速度是一个常数V（在25c时为340m/s）,只要知道了声波从发出到接收到回波的时间就可以用(4-1)求的距离So利用STC12C5A60S2单片机对超声波传感器发出超声波到接收到回波的时间进行计时，就可以得到图4-2中的Hi和H2的值，从而就可以推算出车体的倾角-

28、 - arcsinH2 -Hi(4-2)这个计算的过程可以由STC12C5A60S2单片机完成，在求得倾角a后单片机可以根据倾角的大小按编程时指定的PID算法再结合PWM技术使电机产生不同速度的转动，来维持车体的平衡。方案二的优点：超声的波长很大，在经过地面反射的时候对地面的颜色和平整度要求不高，即采用这种方案能适应更一般性的场合；通过连续测量到地面的距离,可以比较精确的得到车体的倾角，从而在控制电机的转动时可以引入PID算法,使车体平衡的调整变得更精确。方案二的缺点：超声波在空气中的传播容易受到扰动，因为本系统是一个运动的系统，所以受到扰动的概率更大。在倾斜的路面上，比如上坡，这种方案就显得

29、心有余而力不足了。方案三：使用STM32微处理器和陀螺仪以及加速度传感器实现的单轴双轮自平衡机器人。陀螺仪和加速度传感器图3-3基于陀螺仪和加速度传感器的双轮自平衡机器人ENC-03陀螺仪是一种应用科氏力原理的角速度传感器，它输出一个和角速度成正比的模拟电压信号，通过对角速度的积分可以得到角位移，即角度值。MMA7361QR3轴小量程加速传感器是检测物件运动和方向的传感器，它根据物件运动和方向改变输出信号的电压值，通过AD变换就可以直接得到角度值。陀螺仪数据噪声小，短时间内误差小，温度漂移大，积分积累误差较大；加速度传感器对震动敏感，无积累误差，长时间稳定。鉴于陀螺仪和加速度传感器的对称互补特

30、性，本方案中用陀螺仪ENC-03和3轴小量程加速传感器MMA7361QR进行传感器数据融合得到车体倾角，这种方法获得的角度值很精确，并且可以最大程度的降低车体抖动对车体倾角检测的影响。为了方便对参数的调整，本方案中的互补对称滤波使用软件实现，因此需要一个高性能的微处理器做为核心处理器。出于性价比的考虑最终选择了意法半导体的STM32微处理器做为核心处理器。陀螺仪和加速度传感器分别得到车体倾角值，经STM32的处理后得到数据融合后的精确车体倾角值，STM32根据此角度值通过PID算法和PWM技术来精确的控制电机转动，使车体保持平衡。方案三的优点：车体的倾角的获取不依赖于单轴双轮自平衡小车所处的环

31、境，具有普遍的适用性。采用了多传感器的数据融合技术，减小了单一传感器的固有缺陷对测量精度的影响，提高了测量精度。方案三的缺点：使用多组传感器和高性能的控制器，成本上有所增加。通过对以上三种方案的理论分析和实验对比，最终确定使用方案3来实现单轴双轮自平衡机器人。3.1 硬件设计方案论证如图3-4所示，采用模块化的设计思想，将系统分为，电源模块，主控制器模块，角度与加速度传感器模块，电机驱动模块，电机测速模块，人机交互模块。人机交互模块完成各种用户参数的输入和自平衡机器人的当前状态参数的显示，其主要由一块液晶屏和一片STC12C5A60S2单片机组成，人机交互模块获得的用户输入参数由STC12C5

32、A60S2通过串口传送给主控制器STM32,人机交互模块要显示的信息由STM32通过串口传送给STC12C5A60S2;陀螺仪得到的角速度模拟量由STM32自带的12位高精度，高采样率的AD转换器将其转化为数字信号，加速度传感器输出的角度值由STM32通过IIC总线读取，在此之后STM32对这两路传感器的数据进行对称互补滤波融合，得到准确的车体倾角，根据这个倾角值以及光电码盘测速模块返回电机转速参数，STM32按照PID算法得电机转动的速度和角度，再通过串口给电机驱动模块发送相应的命令，使其转动来维持单轴双轮自平衡系统的稳定。电机驱动模块中运用了PWM技术对电机的速度进行控制。同时光电码盘测速

33、模块对电机的转速进行测量，并反馈到系统中，辅助系统完成PID控制算法。图3-4单轴双轮自平衡机器人的原理框图3.1.1 .1电源设计本系统是一个移动的系统，又有电机等大功率器件，因此采用四块6V10Ah的铅酸电池做为系统的电源，接法为两用两并，形成一个12V20Ah的直流电源。由于系统中存在着多种微控制器，需要5V和3.3V的电压源。这两个电压源用12V直流电源通过稳压模块获得。目前比比较常用的电源稳压芯片从工作原理上分为两种，一种为线性稳压，另一种为开关稳压。如图5-1、图5-2所示是两种典型的稳压电路。图3-52576开关稳压芯片应用电路图4-27805线性稳压芯片应用电路从电路中很明显可

34、以看出他们之间的差别，开关电源稳压芯片的外围电路器件相对较多，比较复杂；而线性稳压电源的外围电路相对简单，更节省PCB板空间。开关稳压芯片的输出纹波系数一般比较大，而线性稳压芯片的输出纹波系数一般比较小。但是线性稳压芯片的转换效率很低，特别是当需要降低的电压范围比较大的时候，往往低于50%;而开关稳压芯片的转换效率通常可以达到95%。转换效率低还带来了一个问题就是稳压芯片自身会发热，使其稳压性能迅速恶化。以上分析并不能说明开关稳压芯片就一定好，要根据具体的应用场合合理的选取。在本系统中5V的电压源负载比较重，对电压纹波也不是很敏感，所以12V到5V的稳压模块采用开关电源稳压芯片，电路如图4-1

35、所示。3.3V电压源的负载很轻，主要给加速度传感器供电，对电压纹波敏感，所以选用线性稳压芯片ASM1117,电路如图5-3所示。图5-3系统中3.3V电源稳压电路3.1.2 主控模块设计主控模块采用意法半导体的STM32F103ZET6芯片搭建的一个硬件平台。STM32F103ZET6是一款ARM32位的Cortex-M3内核的微处理器，512K字节的闪存程序存储器，高达64K字节的SRAM,最高时钟频率为72MHz,三个12为模数转换器，多达21通道，支持12通道的DMA,多达13个通信接口其中有5个USART,多达112各通用IO口。ADC为陀螺仪的输出模拟信号的 AD转换提供了方便,5个

36、USART为各模块和主控电路之间的通信提供了方便的接口6I箕 $L.WIb m .MWgMrie 3 A N NTMCfTn r & Mblluu-feLttHl mJWIT ft? I b 1A 5 MTU nClMlKT- DM i«nIVU1WL- M ¥1询工Al MTN W>W«- 2 irtrawL'm w>TWC 2 hW +m'MCli9MT MTU 方E44 LMbi-M JUU awAnr* iHvsw Mnwa e禺k；*弓制JtlSMLl IMHIM. Jill mr m «-WT第 n Kii

37、 真工2JIU制K fCJ皿独 E晨 HU4 0 2 的，如m* JImjmilT出炉 雄 血. jMMIgLiumaue m'Mic miiiw o&imc cwJ nTDfl qri、皿 b411Ml CtUim NVSA 3 F!I*T 14M .huBM H U-Nh& hLi- -g EHgQ » PM1T1W EILim Hi IulH* AHi 霓jpguc UQvrnuft cw nW.il K1HWCHI j»Svi.'i tMUbwu JMinau m 7WMTUTM； ,WaTli FBMlAKWWOiHWU 支出* 口

38、E Pfili go in Id RJIfaW.'心 Kl LMW- 4 NllZMIf mHll i»NL ML14 3 rGKYHWC NCF-l 加 招朋EK： W *； FkT? EtVL K l-frtML MLt： FTYi'W MWflIT E i* g ) NWE NCilKUrIW-' L.1X RmHTH14ABin WOW) CM> K>bi-Hr CKIUHM- m JDOa.' LNfHMJ EEFCIMIMiT TXKm CT n iBIIHABII ,垢 H JUU.tC 函不 MEE L 1W塾负， Hn=H

39、ZImTiIWI mi".Tnui E U Ml Cl 三喝7TMr? 日 Hid心心廿33Wi'WI? IMTIMI CXTblh CICM MliADL'IT h-Rl IM>Ml L*刷WII-TML' W3lli!-Wlfewr H VA .nrowrir 也 :A* m-fffeh-MU-9 Klh-HML- Ml wwrw a * 5NMMTWa 的 乜济1HlUTI mr-AMTIMI HTBllVBCr Ml l；33 I CI&LOR.MXTIUi CWUW3H fAlWr UflTI IKUMI CWRUMHI MX I Cb

40、J>MLV rrhrrw rMtonm Kfe llM m-KI£l Or 1R7M C*&iro H K.wzc unLirM CHinEm a- w£ .WK IP PC* RTfWw- rMh Rjsair iNnIT*ii"pTT*KiIE lUHMC- m HIIHMZ 岫 IHHCMWi阳源 wiwwr 口iiMAMi点的 jS>m工tMRTSUlVMaT- II1i"I1MP CQH-13g MX?沿IWJ4 羽ktrczN-押rTfcFD=nH-由于本系统涉及到了一些数字信号处理，使用专用的DSP芯片成本会很高，而且开

41、发难度也很大。所以采用了一种折中的芯片选型方案，选择了一款高性价比的嵌入式微处理器做主控板。从STM32F103ZET6的指令的吞吐量和存储空间上看，此款芯片很适合做为本系统的主控芯片。通其丰富的外部设备，如图5-5STM32主控板原理图（部分）图5-6为STM32F103ZET6的时钟电路，OS1为高速时钟，为STM32F103ZET6内核和外部设备提供工作时钟。OS2为一个低频晶振，为STM32F103ZET6提供实时时钟。图5-7为STM32F103ZET6的复位电路，采用积分型复位电路，复位为低电平有效，此电路具有上电复位和按键复位的功能网。OS1JTAGIIDGND图5-6STM32

42、主控板时钟电路图5-7STM32复位电路图5-8STM32JTAG仿真接口电路图5-8为STM32的JTAG仿真接口电路，在一个复杂系统中，软件调试往往很花费时间，如果系统上留有JTAG接口，可以通过JTAG对系统进行在线调试，可以让程序单步执行，从而可以查看程序的运行路径，很容易定位软件中的逻辑错误，提高开发效率。3.1.3 电机驱动模块通过近一段时间的研究，直流有刷电机的正反转驱动电路常用的有以下四种9,下面就对他们的特性进行分析。方案一：继电器搭建的H桥电路；图5-9继电器H桥电路在大功率电机驱动中继电器实现的H桥电路是一种性价比很高的设计方案,它能承受的电流很大，同时能实现编程控制电机

43、的正反转。但是继电器动作过程中有机械运动，所以其能达到的响应速度不高，继电器的典型响应时间为2ms,不适合高速的应用场合。同时继电器的触点容易产生火花，影响继电器的寿命。方案二：L298搭建的直流电机驱动电路L298N是SGS公司的产品，内部包含4通道逻辑驱动电路。是一种二相和四相电机的专用驱动器，内含二个H桥的高电压大电流双全桥式驱动器，接收标准TTL逻辑电平信号，可驱动46V、2A以下的电机。用L298搭建的电机驱动电路的稳定性很好，但是其能承受的电流比较小。图5-10L298直流电机驱动电路方案三：大功率MOS管搭建的H桥电路图5-11大功率MOS管H桥电路这个电路是在研究单轴双轮自平衡

44、小车的时候自行设计的电机驱动电路，两个PMOS和两个NMOS管搭建了一个H桥，为了防止PMOS和NMOS同时导通形成短路现象，利用LM324形成互锁的驱动机制，使没一边的PMOS和NMOS始终只有一个处于导通状态。但是在测试的时候发现MOS管还是发烫，经过仔细分析发现，原因是LM324的输出端得电平变化沿不是陡峭，既两个MOS管存在同时导通的现象，虽然这个过程十分的短暂，但是短路电流很大，所以MOS管发烫。改进办法是在NMOS管和地之间插入一个NMOS管。在LM324电平转变的时候先是插入的NMOS管截至。这样就防止了短路发生，MOS也不发烫了。方案四：基于BTS7960的H桥驱动电路II-n

45、-TKLKMK：:本工士"J图5-12BTS7960H桥驱动电路智能功率芯片BTS7960是应用于电机驱动的大电流半桥高集成芯片，它带有一个P沟道的高边MOSFET、一个N沟道的低边MOSFET和一个驱动IC,集成的驱动IC具有逻辑电平输入、电流诊断、斜率调节、死区时间产生和过温、过压、欠压、过流及短路保护的功能。BTS7960通态电阻典型值为16mQ,驱动电流可达43A。上图是由四个BTS7960搭建的一个双电机驱动电路，可同时驱动两个直流有刷电机。通过对上面四个电路特性分析和对比后发现，继电器H桥电路的响应速度太慢无法满足本系统的实时性要求；L298电机驱动电路其电流驱动那能力太

46、差，无法满足本系统功率要求；大功率MOS管H桥电路，性能很不错，但是体积过大，不利于潜入到本系统中；本系统选取了性能稳定的基于BTS7960的H桥驱动电路作为电机的驱动电路。BTS7960的H桥驱动电路采用了模块化设计，将STC12C5A60S2单片机集成到驱动板上，四个BTS7960芯片直接受STC12C5A60S2的控制，STC12C5A60S2E通过串口从STM32主控板接收到电机控制命令后，产生相应的电机驱动电路控制时序。电机调速采用脉冲宽度调制（PWM）方式实现，PWM是利用微处理器的数字输出来对模拟电路进行控制的一种非常有效的技术，广泛应用在从测量、通信到功率控制与变换的许多领域中

47、。本系统中，PWM主要用于电机调速，属于PWM在功率控制中的应用。STC12C5A60S2单片机含有两路硬件PWM发生器，可以产生最高频率为150KHz的PWM调制输出。STC12C5A60S2的PWM输出引脚为P1.3和P1.4,将这两引脚连接到BTS7960芯片的INH引脚上，只需在软件中设置比较寄存器CCAP0H、CCAP0L进行设置就可以完成PWM调制。3.1.4 码盘测速模块为了精确地控制电机的转动，为PID控制算法提供反馈信号，必须对电机的转速进行测量。常用的非接触转速的测量方法有两种，一种是利用霍尔传感器，另一种方案是利用光电码盘10。霍尔传感器感应的是磁场强度的变化，需要和磁钢

48、配合使用才能完成对转速的测量；它的优点是能工作于灰尘多等恶劣的环境中，它的不足之处是做高精度的测量时，需要大量的磁钢，安装麻烦。光电码盘利用反射式红外传感器进行测量，码盘的制作和传感器安装都比较容易，但是涉及到了光电器件，在多灰尘等恶劣环境中无法正常工作。考虑到本系统是用于实验室环境，所以选取光电码盘方式对电机的转速进行测量。图4-13光电测速码盘根据控制精度白要求，采用60线的码盘作为测速码盘，如图5-13所示，码盘的基板采用ABS板制作，作用黑色记号笔画上线条。图5-14为光电码盘测速模块的电路原理图，反射式红外传感器ST188的发射管发射出红外先进过码盘的反射后进入ST188的红外接收管

49、，接收管按上图中的接法偏置后，在接收到红外光信号时ST188的C管脚上的电压将会降低，当没有接收到红外光信号时,ST188的C管脚呈现图电平。一般的情况下按图5-14中电路配置，ST188的C管脚输出的低电平可以直接触发单片机的中断，但是为了增加系统的稳定性，在红外传感ST188和STC11F04E之间力口入了一个电压比较器LM324对ST188的C管脚输出的信号进行二值化，得到一个脉冲序列。当码盘转动的时候就可以形成如图5-15所示的脉冲序列，用单片机对脉冲序列进行计数，将该数值除以对应的时间就可以求的电机的转动速度。单片机完成每次的速度检测后通过串口把速度数据发送给主控微处理器。图4-1

50、4光电码盘测速模块电路图卡卡玉卡FH图4-15二值化红外传感器测速信号3.1.5 倾角检测模块MEMS传感器是采用微电子和微机械加工技术制造出来的新型传感器。与传统的传感器相比，它具有体积小、重量轻、成本低、功耗低、可靠性高、适于批量化生产、易于集成和实现智能化的特点7。本系统中采用了MEMS类型的加速传感器和陀螺仪两个传感器构成，以下是对它们的详细介绍：1.加速度传感器Freescal公司的MMA8451Q是14位/8位智能低功耗三轴数字加速度计，工作电压1.95V-3.6V,接口电压1.6V-3.6V,动态可选择满刻度为及g/Mg/2g,输出数据速率(ODR)从1.56Hz到800Hz,噪

51、音为99ug/，Hz,1附和8位数字输出,MMA8451使用I2C串行通信和外部交换数据,由于MMA7260加速度传感器可准确测量三轴向下降、倾斜、移动、定位、撞击和震动，因此主要用在电子罗盘，静态姿态、运动检测，笔记本电子书等便携设备的翻滚、自由落体检测，实时的方向检测可用于虚拟现实设备或3d游戏中的位置检测，便携设备的节能应用中的运动检测等等。表5-1引脚定义如下：引脚编号引脚名称引脚描述引脚状态1VDDIO内部电源供电(1.623.6v)输入2BYP旁路电容输入3NC悬空引脚开路4SCLI2C串行时钟漏极开路5GND接地输入6SDAI2C串行数据漏极开路7SA0FI2C最低有效位地址输入

52、8NC悬空引脚开路9INT2中断请求引脚2输出10GND接地输入11INT1中断请求引脚1输出12GND接地输入13NC悬空引脚开路14VDD电源(1.953.6v)输入15NC悬空引脚开路16NC悬空引脚开路MMA8451Q有四种可选加速度范围，分别对应不同的灵敏度，以适应不同的应用环境和系统要求，配置参数表5-2所示。设置方法通过IIC总线接口想XYZ数据设置寄存器XYZ_DATA_CFG写入相应的值。MMA8451Q的写操作器件地址为0011100,读操作器件地址为0011101。表5-2MMA8451Q模式配置参数:FS1FS0；量程002g014g108g11保留2.陀螺仪ENC-0

53、3RC,是日本村田公司(murata)开发生产的一款以陶瓷材料为主要原料的角速度传感器，又名陀螺仪，该产品是一种应用科氏力原理的角速度传感器，它输出一个和角速度成正比的模拟电压信号芯片特性：1）供电电压：2.75.25V2）最大角速度deg./sec.+/-3003）输出（当角速度=0）:1.35V4）比例系数：0.67mV/deg./sec5）线性度:+/-5%FS6）响应频率：50Hz7）重量:0.4g如图5-17所示，左侧的三个为ENC-03RC,其输出的角速度信号经过滤波和放大后被引到了模块的输出引脚上，由主控模块对此信号进行AD转换，得到数字化的加速度值，对角速度积分就可以求取角度。

54、右侧的为电源稳压电路和AMM4851Q加速度传感器。AMM4851Q加速度传感器是数字接口器件，可以通过IIC总线协议设置AMM4851Q的工作模式和读取角度值。图5-17加速度传感器和陀螺仪构成的倾角检测模块电路原理图3.1.6 人机交互模块HWPl. ATI PI I TT-EKK4PLJKJ 皿PL3K-.1AD2玩Xa£UMJ切g也，皿Pl d.lUSDM.S AD?PI. 7.3£XK'Ji MMR3TM5AD-TO Q RAD耳 VWK.LTaDALE1XROO-M2 on?P"BJtTP1FL5MATE'虹"UK-iLTlS

55、U AUpj a witpixuji./.iiDd. ALi.花ELJntALU* KT3再 I MQ?2 i? AS第 M寻二 c: 上l Kl:噎±上：+=F¥图5-18人机交互模块原理图如图5-18所示，人机交互模块由STC12C5A60S2单片机、Nokia5110液晶、矩阵键盘构成。Nokia5110液晶用于显示系统当前的状态，如当前时间、速度、倾角、电量等信息；矩阵键盘用于时间等用户初始化信息的调整。用户输入信息先有单片机缓存，在用户确定之后通过串口发送给主控模块STM32;液晶屏显示的数据是STM32通过串口发送给单片机的。单片机完成了液晶屏的驱动14、矩阵键

56、盘的扫描，这样不会消耗主处理器的资源，减轻了主控制器的程序设计难度。3.1.7 通信模块本系统采用了模块化设计方案，将整个单轴双轮自平衡小车自顶向下的划分为主控器STM32模块，人机交互模块，陀螺仪模块、加速度传感器模块、电机驱动模块、光电码盘测速模块。主控模块采用了STM32微处理器，其他的模块都采用宏晶公司的51内核的单片机实现。在设计通信协议的时候为了方便起见，加速度传感器和STM32主控板之间的通信采用了IIC通信协议。考虑到本系统使用的宏晶公司的51内核单片机基本上都有硬件串口，而且STM32有5个USART所以人机交互模块、电机驱动,g块、光电码盘测速模块与STM32主控模块之间的数据交换全部采用串口通信方式进行，波特率设置为9600,数据位为8位，无奇偶校验。3.2 软件设计方案软件部分也采用模块化设计方法，先在各个硬件模块上完成相应功能的程序模块的设计，之后再添加通信模块，并将各子模块挂在STM32上进行联调。人机交互模块，光电码盘测速模块，电机驱动模块所使用的微控制器都是STC12C5A60S2单片机，主要就是驱动一些常用的外部设备,所以编程相对来说比