双轮直立智能机器人平衡控制系统设计

《双轮直立智能机器人平衡控制系统设计》由会员上传分享，免费在线阅读，更多相关内容在工程资料-天天文库。

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

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

3、决策以及自身的行为控制等功能，它具有很高的军事、商业价值⑴。近年来，移动机器人已经得到广泛的应用，几乎渗透到各个行业，所实现的功能也是越来越复杂，例如应用于核电站、军事应用、宇宙探索、防灾救灾、危险品运输、地形勘探、海洋开发等。轮式移动机器人作为移动机器人的一个重要分支。轮式移动机器人比较适合在狭窄和大转角场合工作，因此轮式移动机器人的实用价值和理论价值都罪常高⑵。1.2国内外研究现状在二十世纪八十年代末，H本东京电信大学自动化系的山藤一雄教授最早提出了双轮直立自平衡机器人的设计思想，并于1996年在口本通过了专利申请。如图1-1所

4、示，机器人沿固定轨道行走，不能实现转弯等动作。所以其研究并没有受到太多人的重视。育•到木世纪初，人们才重新关注两轮宜立平衡机器人，各国开始研发自己的两轮智能平衡机器人。国外的开发的机器人占了绝大部分，处于领先地位，国内的机器人主要述处在理论研究阶段，只开发了少数的原型机⑶。图1-1早期自平衡机器人1.3课题研究内容本课题研究的主要内容是微型直流电动机的控制与驱动，双轮直立智能平衡机器人的平衡控制系统两方面内容。双轮智能平衡机器人的平衡控制系统采用S08单片机作为控制器，采用倾角传感器和加速度传感器组成姿态传感器来检测车体平台的倾斜角

5、度和倾倒速率,运用PWM脉宽调制技术控制驱动直流屯机；姿态传感器的检测输出为反馈信号输送给控制器，根据反馈信号采用PTD控制算法调节控制器输岀的PWM脉宽的占空比，从而改变直流电机的转速以实现系统的平衡。2总体设计方案两轮直立智能平衡机器人根据运动特性可分为机械系统和控制系统两个主要部分，其中控制系统主要包括：电机、驱动电路、姿态检测系统、电源电路以及MCU控制器等。木设计主要研究智能平衡机器人的控制系统，其主要的任务是：检测机器人车体倾倒的角度和角速度，以及直流电机的转速和转向，调节机器人行进的速度以实现机器人系统的平衡控制。2.

6、1双轮智能平衡机器人的工作原理将双轮直立平衡机器人系统简化成放置在可以左右移动的车轮上的倒立摆模型，如图2-1所示。它具有三个自由度，分别是：以倾斜角度0为描述对象，绕x旋转；以（

7、）为描述对象，绕z旋转；以片和乙为描述对象，沿y轴方向的位置移动。其中，e为机器人体的倾斜角度，e为机器人的旋转角度，机器人左轮的移动速度为引，匕•表示机器人右轮的移动速度⑸。图2-1两轮直立平衡机器人模型假设系统的参数为：加为机器人体质量，左右轮的质量为nij=mr,几为机器人体转动惯量，以厶表示绕机器人体质心的转动惯量；Jx=Jr为轮子的转动惯量，R

8、为轮子的半径，厶为机器人体质心到两轮轴间的距离，.f为两轮间距的一半。系统的总动能包括机器人体的转动动能刁，平动动能石，左右轮的转动动能7；和平动动能以及车轮绕轴转动的动能7；⑹。它们的表达式分别如下式所系统的总动能t=t^t2+t3+t4+t5T=^m-R2^i~^f^sin20+—瓯cos0—£/?(&+叫+^2L2sin2^>++("疋。：+mrR20^)++J,.0；++J0；+-^-+-+£("+加J/审依据对双轮直立机器人的动力学和运动学分析可知：控制机器人车模直立平衡的条件是能够精确测量车模倾角的大小和倾倒角速度的大小

9、以及可以控制车轮的加速度。2.2机器人平衡控制系统方案分析根据双对轮直立智能机器人的动力学和运动学分析设计平衡控制系统。双轮直立智能机器人的平衡控制系统采用S08微控制器作为控制系统的核心控制器,采用倾角传感器和加速度传感器组成姿态传