双轮机器人平衡控制系统设计

1、2012届毕业生毕业设计说明书题目：双轮直立智能机器人平衡系统设计1概述31.1 轮式智能机器人的研究背景及意义31.2 国内外研究现状31.3 课题研究内容42总体设计方案42.1 双轮智能平衡机器人的工作原理52.2 机器人平衡控制系统方案分析63微控制器和检测电路设计73.1 S08微控制器73.2 角度和角速度检测模块83.3 速度传感器114驱动电路及电源模块设计124.1 微型直流电机124.2 电机驱动模块124.3 电源模块设计135软件设计145.1 S08AW60微控制器资源配置145.2 PID控制原理165.3 程序设计17总结211概述1.1 轮式智能机器人的研究背景

2、及意义随着科学技术的迅速发展，人类进入了数字化、智能化时代，计算机科学和控制理论的发展为人类制造高度智能的仿真机器人提供了可能。专家预言，二十一世纪将是机器人的时代。从上个世纪八十年代开始，机器人技术逐渐形成了一个比较系统的科学体系，它将力学、机械学、电子技术、传感器技术、计算机技术、控制理论和算法等学科融为一体，不断吸收其它相关学科的最新研究成果，形成了一门独立的高科技学科。移动机器人是现代机器人中的一个重要的分支，它能够根据指定的命令，自主运动到特定位置，具备对工作环境的感知和自我适应、运动的实时决策以及自身的行为控制等功能，它具有很高的军事、商业价值10近年来，移动机器人已经得到广泛的应

3、用，几乎渗透到各个行业，所实现的功能也是越来越复杂，例如应用于核电站、军事应用、宇宙探索、防灾救灾、危险品运输、地形勘探、海洋开发等。轮式移动机器人作为移动机器人的一个重要分支。轮式移动机器人比较适合在狭窄和大转角场合工作，因此轮式移动机器人的实用价值和理论价值都非常高2。1.2 国内外研究现状在二十世纪八十年代末，日本东京电信大学自动化系的山藤一雄教授最早提出了双轮直立自平衡机器人的设计思想,并于1996年在日本通过了专利申请。如3图1-1所示，机器人沿固定轨道行走，不能实现转弯等动作。所以其研究并没有受到太多人的重视。直到本世纪初，人们才重新关注两轮直立平衡机器人，各国开始研发自己的两轮智

4、能平衡机器人。国外的开发的机器人占了绝大部分，处于领先地位，国内的机器人主要还处在理论研究阶段，只开发了少数的原型机KAZUOYKCPHCT。图1-1早期自平衡机器人1.3 课题研究内容本课题研究的主要内容是微型直流电动机的控制与驱动，双轮直立智能平衡机器人的平衡控制系统两方面内容。双轮智能平衡机器人的平衡控制系统采用S08单片机作为控制器，采用倾角传感器和加速度传感器组成姿态传感器来检测车体平台的倾斜角度和倾倒速率，运用PW做宽调制技术控制驱动直流电机；姿态传感器的检测输出为反馈信号输送给控制器，根据反馈信号采用PID控制算法调节控制器输出的PW嘛宽的占空比，从而改变直流电机的转速以实现系统

5、的平衡。2总体设计方案两轮直立智能平衡机器人根据运动特性可分为机械系统和控制系统两个主要部分，其中控制系统主要包括：电机、驱动电路、姿态检测系统、电源电路以及MCU控制器等。本设计主要研究智能平衡机器人的控制系统，其主要的任务是：检测机器人车体倾倒的角度和角速度，以及直流电机的转速和转向，调节机器人行进的速度以实现机器人系统的平衡控制。2.1 双轮智能平衡机器人的工作原理将双轮直立平衡机器人系统简化成放置在可以左右移动的车轮上的倒立摆模型，如图2-1所示。它具有三个自由度，分别是：以倾斜角度8为描述对象，绕x旋转；以？为描述对象，绕z旋转；以VI和v,为描述对象，沿y轴方向的位置移动。其中，8

6、为机器人体的倾斜角度，？为机器人的旋转角度，机器人左轮的移动速度为VVr表示机器人右轮的移动速度5。图2-1两轮直立平衡机器人模型假设系统的参数为：m为机器人体质量，左右轮的质量为mi=m,，蛇为机器人体转动惯量，以J表示绕机器人体质心的转动惯量；J=J.为轮子的转动惯量，R为轮子的半径，L为机器人体质心到两轮轴间的距离，f为两轮间距的半。系统的总动能包括机器人体的转动动能Ti,平动动能T2,左右轮的转动动能T3和平动动能丁4,以及车轮绕轴转动的动能丁56。它们的表达式分别如下式所示:TJ2J孑2Il=22T20V2V2V21212T3"m,Vi_mrVr22T4/JrYIJ&quo

7、t;191一T5=2j.=2mm.f系统的总动能T-T；T2T3T4T51R2粒42L2sin2g1omWJ222.2目!T=-m2+'i-0LcosQR+斗+9Lsin日卜24f22l11+1(mF2d2+mrR2e；计1je：+1Jid2+J+J夕+1(m+mr)f2e2222222依据对双轮直立机器人的动力学和运动学分析可知：控制机器人车模直立平衡的条件是能够精确测量车模倾角的大小和倾倒角速度的大小以及可以控制车轮的加速度。2.2 机器人平衡控制系统方案分析根据双对轮直立智能机器人的动力学和运动学分析设计平衡控制系统。双轮直立智能机器人的平衡控制系统采用S08微控制器作为控制系统

8、的核心控制器，采用倾角传感器和加速度传感器组成姿态传感器来检测车体平台的倾斜角度和倾倒速率，采用光电码盘测量机器人的行进速度，运用PW脉宽调制技术控制直流电机；姿态传感器的检测输出为反馈信号输送给控制器，根据反馈信号采用PID控制算法调节控制器输出的PW脉宽的占空比，从而改变伺服电机的转速以实现系统的平衡。，双轮直立智能机器人平衡系统的组成如下图2-2所示：图2-2平衡控制系统框图3微控制器和检测电路设计3.1S08微控制器Freescal#导体公司的8位MC9s08AW60控制器有特性如下网：中央处理器单元?高达40MHZCPLW钟频率和20MH也部总线频率，工作电压为4.5V至5.5V,且

9、温度范围为-40C至IJ85Co?最多拥有32个中断/复位源。?多达62KB片上可编程Flash存储器，具有模块保护和安全选项功能。?长达2KB的RAM（内存）。?安全电路防止未经授权的访问内存和闪存内容。省电模式与系统保护?两种停止节电模式和一种等待节省模式。?允许时钟保持启用特定外设站模式。?低压检测复位或中断。?非法操作码检测复位。?非法地址检测复位。?闪光块保护。时钟源的选择?可连接外部振荡器（XOSC,晶体或陶瓷谐振器的低频范围是31.25KHZ到39.0625KHZ,其高频范围是1MHz£16MHz?可选的看门狗复位，微控制器工作正常重置选项专用1千赫的内部时钟源和时钟总

10、线。输入/输出?具有6个通用I/O端口。?I/O引脚用做输入端时，可软件选择上拉电阻；用做输出端时，可软件选择强/弱驱动能力和压摆率。POWER1C1hVDDGNDGNDVDDR2GNDILC5XTAL-ITGNDC2GNDR1,VREFH,VDDADMC9S08PTA0PTA1PTA2,VSSADPTA3VREFLPTB0,VDDPTB1PTB2VSSPTB3PTD0,RESETPTD1PTD2XTALPTE2PTE3PTF4'EXTALPTF5图3-1MC9s08微控制器最小系统电路图3.2 角度和角速度检测模块加速度传感器MMA726原用信号调理、单极低通滤波器和温度补偿技术。该

11、器件带有低通滤波和0g补偿，提供休眠模式，低功耗，性能稳定，抗震动能力强网。因而是电池供电的无线数据采集的理想之选。SCA610-CA1H1倾斜角度传感器是VTI公司采用电容式3D-MEM战术设计、生产的陀螺式倾斜角度传感器。此倾斜角度传感器具有显着的负载能力和非常好的冲击耐久性，并且在全温度区都能表现出它卓越的可靠性，超凡的稳定性和高精度1°,单电源供电压+5V,模拟电压输出范围4.75V-5.25V,测量量程土1g（±90度），八引脚塑料表贴封装，增强的失效检测功能，数字激活式电气自我检测功能，校正存储器的奇偶校验核实功能，连续连接失效检测功能，传感组件的频率响应可控，

12、兼容ROHSS准，支持无铅焊。机器人车体的倾斜角度和由SCA610-CA1H1直接输出，角速度可由角度信息微分得到，再依据MMA726的输出对角度和角速度进行补偿矫正，从而得到精确且稳定的角速度和角度信息。综合考虑，本设计选择由MMA7260DSCA610-CA1H1组成的角度检测传感器。可以根据逻辑输入引脚g-Select1和g-Select2的输入电平选择MMA726的灵敏度（见表3-1）。依据MMA726的说明书，图3-2中阻容滤波电路的选择电阻R=1KC,电容C=0.1忤。高精度单轴倾斜角度传感器SCA610-CA1H1G线如图3-3所示，图中电阻R=1KC,电容C1=0.1NF,电容

13、C0=47nF。表3-1MMA7260的控制引脚g-Select与灵敏度选择g-Select1g-Select2量程灵敏度输入电平001.5g800mV/g102g600mV/g014g300mV/g116g200mV/gVDDVCC_TC4接S08的B口R1VSS，RES1C1XOUTGNDGNDR2RES1C2sleepmodeYOUTg-select1GDg-sslect2GNDC3R3RES1ZOUTMMA7260图3-2MMA7260典型接线图VCC工连接S08GNDC0SCA61081726354接S08白处口GND图3-3SCA610-CA1H1G接线图双轮直立机器人所采用的姿态

14、角度检测系统主要由加速度计MMA7260倾角传感器SCA610-CA1H1GS08微控制器、滤波电路等部分组成。姿态检测系统的硬件平台如图3-4,由微处理器S08对SCA610-CA1H1GMMA726的输出进行高速A/D采样后，对倾斜角度和角速度数据进行处理和补偿，由加速度计MMA7260对倾角传感器SCA610-CA1H1G行补偿矫正得到准确的姿态角度信号，再通过微分得到系统倾倒的角速度，此位置信息再通过PID控制器运算，输出PWMB号，进而对电机进行控制。图3-4姿态角度检测系统框图3.3 速度传感器速度传感器采用固定在直流电机输出轴上的光电码盘，如图3-5所示。由于光电码盘输出数字脉冲

15、信号，因此可以直接将这些脉冲信号连接到微控制器S08的计数器端口。每个光电管输出两个脉冲信号，通过S08的计数器检测一路脉冲信号的频率得到电机的转速。由于其输出的两个脉冲信号波形相同，只是相位相差90。，如果电机正转，第二个脉冲落后90。；如果电机反转，第二个脉冲超前90。；因此还可以判断电机的正反转13。图3-5光电码盘测速电路4驱动电路及电源模块设计4.1 微型直流电机微型直流电机的效率一般都要高于其他类型的电机，且在相同的输出功率的情况下直流电机体积一般都比较小，合适应用在空间位置有限的场合，微型直流电机可以根据负载大小自动调速，以达到极大的启动扭矩。交流电机就很难实现这一功能。另外直流

16、电机比较容易吸收负载大小的突变，电机转速可以自动适应负载大小的波动。微型直流电机易于与计算机连接采用PW腋术控制。无刷直流电机虽然没有机械电刷和换向器的直流电机，它的输出力矩正比于电流，速度正比于电压，反电势正比于电机转速，因此其控制特性与机械特性均与普通直流电机基本相同7。但是无刷直流电机的控制系统复杂，所以双轮直立机器人采用微型直流电机作为动力系统。4.2 电机驱动模块用L298N驱动直流电机的电路如图4-1,输出端OUT1、OUT2驱动直流电机。IN1、IN2、IN3、IN4引脚从S08微控制器接输入控制电平，控制电机的正反转，使能控制端ENA,ENB用于PWM控制，图中电容C1=C3=

17、100叶,电容C2=C4=0.1NF。桥式驱动电路L298N采用PWM技术实现电机调速，不仅电路简单而且调速范围大。当无须调速时，可将调速控制端引脚ENA,ENB接5V,使电机工作在高速状态，则电机的旋转方式与输入信号控制端IN1、IN2、IN3、IN4的电平的关系如表4-1:表4-1电机旋转方式与输入信号端的电平的关系电机旋转方式控制端IN1控制端IN1控制端IN3控制端IN4正高低M1图4-1L298N驱动微型直流电动机的电路图4.3 电源模块设计7.2V、智能直立机器人使用的电源由6节相同型号的电池串联起来而得到2A/h可充电电池组提供，直流电机使用7.2V蓄电池直接供电。虽然S08微控

18、制器系统，姿态传感器模块和光电码盘均需5V电源供电，但是S08微控制器系统要求供电电源稳定、纹波小以及线性度好，所以选用LM2940稳压电路单独对其进行供电，如图4-2所示，图中电容C1=C3=100叶，电容C2=C4=0.得F。而传感器模块要求供电电源有较大的电流、较高的转换效率、带负载能力强，则选择LM2596稳压电路进行供电，如图4-3所示。利用LM2940对S08微控制器系统供电，采用LM2596对检测模块供电，可以有效地防止各器件之间产生干扰，和电流不足的问题，使得系统能够稳定地工作。iNnoutG5VC47.2V-厂丁.一C2LM2940/_GND图4-2LM2940稳压电路GND

19、图4-3LM2596稳压电路5软件设计5.1 S08AW60微控制器资源配置S08AW60的通用IO可通过设置相应的寄存器使其具有输入、输出、内部上拉选择、斜率控制及驱动强度控制等功能。选择IO端口工作方式的控制寄存器有端口数据方向寄存器PTxDD,端口数据数据寄存器PTxD,内部上拉控制寄存器PTxPE及驱动强度选择寄存器PTxDS等。S08的端口控制字的含意如表5-1:表5-1S08的IO端口控制字寄存器名寄存器值端口功能PTxDD0输入端口1输出端口PTxPE0内部上拉关闭1内部上拉使能PTxDS0低驱动强度1高驱动强度光电码盘的输出脉冲信号连接到S08微控制器的定时器PTM2的PTF4

20、,PTF5弓I脚，定时器PTM2工作在计数模式，定时器PTM1工作在定时模式产生PWM输出。选择端口A做为输出通道，PTA0至PTA3引脚与电机驱动模块L298N的输入信号端IN1到IN4连接控制直流电机的正反转，其寄存器选择见表5-2。选择端口E的PTE2、PTE3弓唧为PWM输出端与L298N的调速控制端引脚ENA、ENB连接，其寄存器选择见表5-3。表5-2端口A的寄存器选择寄存器名PTADD0PTADD1PTADD2PTADD3寄存器值1111寄存器名PTADS0PTADS1PTADS2PTADS3寄存器值1111表5-3端口E的寄存器选择寄存器名PTEDD2PTEDD3PTEDS2P

21、TEDS3寄存器值1111选择端口D的PTD0、PTD1、PTD2引脚为输出端分别连接MMA7260的sleep-modfe、g-Select1和g-Select2引脚，其寄存器选择见表5-4。选择端口B为模拟量的输入通道，PTB0、PTB1、PTB2引脚分别连接MMA7260的XOUT、YOUT和ZOUT弓唧；PTB3引脚连接SCA610的VOUT端；端口B的数据寄存器选择AD1P,数据方向寄存器设置为PTBDD0=0,PTBDD1=0,PTBDD2=0,及PTBDD3=0O表5-4端口D的寄存器选择寄存器名PTDDD0PTDDD1PTDDD2PTDDS0PTDDD1PTDDD2寄存器值11

22、10005.2 PID控制原理在反馈控制系统中PID控制的基本形式如图4-1，模拟PID控制规律如下15:ut=Kpet；：etdtTd等式中，误差函数e(t)=r(t)-y(t),KP为比例增益，为积分时间常数，Td为微分时间常数。被控对象图5-1PID控制的基本形式各环节的彳用如下17:比例环节：迅速反应误差，减小误差，但不能消除稳态误差。比例作用太强会使系统的稳定性下降。积分环节：积累误差，最终消除稳态误差。积分作用太强会增大系统的超调量，使系统过渡过程变长。微分环节：超前控制，克服系统的惯性，加快动态响应，减小超调量，提高稳定性。微分作用太强会引起输出失真。由于计算机控制是离散型数字控

23、制，它只能根据采样时刻的偏差值计算控量。因此，模拟PID控制算法不能直接使用，需要采用离散化而得到数字PID控制算法。数字PID控制算法主要有位置型和增量型两种算法。其中增量型控制算法的特点有：增量仅与最近几次采样值有关，累积误差小；控制量以增量输出，误动作影响小，且不会产生积分饱和现象；可以实现手动与自动的无冲击切换。所以，本设计采用增量型控制算法，设采样周期为T,则有：每步的控制量：uk=uk-uk-1kA因为：uk1=KPek_1KeiKDbk1ek2i0所以增量型控制量为：uk=KPekek一11Klek_1KDbk-2ek-1ek-21=q0ekqek-1q2ek-2式中，q0=KPMi12Td,TDq2-kp°5.3 程序设计双轮智能直立机器人平衡控制系统的软件部分实现的主要功能有：融合处理倾角传感器和加速度传感器反馈的信息，以得到机器人车体倾倒的角度和角速度的精确值；依据车体的位置信息和行进方向，采用增量型PID控制