《基于某单片机地两轮自平衡车控制系统设计》由会员分享，可在线阅读，更多相关《基于某单片机地两轮自平衡车控制系统设计（52页珍藏版）》请在金锄头文库上搜索。
1、word基于单片机的两轮自平衡车控制系统设计摘要两轮自平衡车是一种高度不稳定的两轮机器人，就像传统的倒立摆一样，本质不稳定是两轮小车的特性，必须施加有效的控制手段才能使其稳定。本文提出了一种两轮自平衡小车的设计方案，采用重力加速度陀螺仪传感器MPU-6050检测小车姿态，使用互补滤波完成陀螺仪数据与加速度计数据的数据融合。系统选用STC公司的8位单片机STC12C5A60S2为主控制器，根据从传感器中获取的数据，经过PID算法处理后，输出控制信号至电机驱动芯片TB6612FNG，以控制小车的两个电机，来使小车保持平衡状态。整个系统制作完成后，小车可以在无人干预的条件下实现自主平衡，并且在引入适
2、量干扰的情况下小车能够自主调整并迅速恢复至稳定状态。通过蓝牙，还可以控制小车前进，后退，左右转。关键词：两轮自平衡小车 加速度计 陀螺仪 数据融合 滤波 PID算法Design of Control System of Two-Wheel Self-Balance Vehicle based on MicrocontrollerAbstractTwo-wheel self-balance vehicle is a kind of highly unstable two-wheel robot. The characteristic of two-wheel vehicle is the nat
3、ure of the instability as traditional inverted pendulum, and effective control must be exerted if we need to make it stable. This paper presents a design scheme of two-wheel self-balance vehicle. We need using gravity accelerometer gyroscope sensor MPU6050 for the inclination angle of vehicle, and u
4、sing plementary filter for the data fusion of gyroscope and accelerometer. We choose an 8-bit microcontroller named STC12C5A60S2 from STC pany as main controller of the control system. The main controller output control signal, which is based on the data from the sensors, to the motor drive chip nam
5、ed TB6612FNG for controlling two motors of vehicle, and keeping the vehicle in balance. After the pletion of the control system, the vehicle can achieve autonomous balance under the conditions of unmanned intervention, the vehicle can adjust automatically and restored to a stable state quickly in th
6、e case of giving appropriate interference as well. In addition, we can control the vehicle forward, backward and turn around.Key words: Two-Wheel Self-Balance Vehicle; Accelerometer; Gyroscope; Data fusion; plementary filter; PID algorithm1 绪论11.1 自平衡小车的研究背景11.2 自平衡小车研究意义11.3 论文的主要内容22 课题任务与关键技术22.1
7、 主要任务222.2.1 系统设计22.2.2 数学建模232.2.4 控制算法33 系统原理分析33.1 控制系统任务分解33.2 控制原理43.3 数学模型54 系统硬件设计64.1 STC12C5A60S2单片机介绍74.2 电源管理模块84.3 车身姿态感应模块94.3.1 加速度计104.3.2 陀螺仪124.4 电机驱动模块144.5 速度检测模块165 系统软件设计165.1 软件系统总体结构175.2 单片机的硬件资源配置18185.2.2 PWM输出设置205.2.3 串行通信设置235.2.4 中断的开放与禁止265.3 MPU6050资源配置275.3.1 普通IO口模拟
8、IIC通讯285.3.2 MPU6050资源配置325.4 系统控制算法设计345.4.1 PID算法345.4.2 互补滤波算法355.4.3 角度控制与速度控制355.4.4 输出控制算法366 总结与展望376.1 总结376.2 展望37参考文献38标准文档1 绪论1.1 自平衡小车的研究背景近几年来，随着电子技术的开展与进步，移动机器人的研究不断深入，成为目前机器人研究领域的一个重要组成局部，并且其应用领域日益广泛，其所需适应的环境和执行的任务也更复杂，这就对移动机器人提出了更高的要求。比如，户外移动机器人需要在凹凸不平的地面上行走，有时机器人所需要运行的地方比拟狭窄等。如何解决机器
9、人在这些环境中运行的问题，已成为现实应用中所需要面对的一个问题。两轮自平衡小车就是在这些的需求下所产生的。这种机器人相对于其他移动机器人的最显著特点是：采用了两轮共轴、各自独立驱动的方式工作，车身重心位于车轮轴上方，通过车轮的前后滚动来保持车身的动态平衡，并可以在直立平衡状态下完成前进、后退、左右转等任务。正是由于其特殊的构造，两轮自平衡小车适应地形变化的能力较强，且运动灵活，可以胜任一些复杂环境中的工作。 两轮自平衡车自面世以来，一直受到世界各国机器人爱好者和研究者的关注，这不仅是因为两轮自平衡车具有独特的外形和结构，更重要的是因为其自身的本质不稳定性和非线性使它成为很好的验证控制理论和控制
10、方法的平台，具有很高的研究价值。早在1987年，日本电信大学教授山藤一雄就提出了两轮自平衡机器人的概念。这个根本的概念就是用数字处理器来侦测平衡的改变，然后以平行的双轮来保持机器的平稳。本世纪初。美国发明家狄恩卡门与他的DEKA公司研发出了可以用于载人的两轮自平衡车，并命名为赛格威，投入市场后，引发了自平衡车的流行。由于两轮自平衡车有着活动灵活，环境无害等优点，其被广泛应用于各类高规格社会活动中，目前该车已用于奥运会、世博会、机场、火车站等大型场合。1.2 自平衡小车研究意义由于两轮自平衡小车具有结构特殊、体积小、运动灵活、适应地形变化能力强、能够方便的实现零半径回转、适合在拥挤和危险的空间内
11、活动、可以胜任一些复杂环境里的工作。因此两轮自平衡车有着广泛的应用前景，其典型应用包括代步工具、通勤车、空间探索、危险品运输、高科技玩具、控制理论测试平台等方面。目前自平衡车的应用如自平衡的代步车正在流行开来。因此两轮自平衡车的研究很有意义。1.3 论文的主要内容本论文主要表示了基于单片机的两轮自平衡车控制系统的设计与实现的整个过程。主要内容为两轮自平衡小车的平衡原理，直立控制，蓝牙控制。整个内容分为六章，包括绪论、课题任务与关键技术、系统原理概述、系统硬件设计、系统软件设计和系统的机械安装与调试。第一章主要讲解了课题的研究背景与意义，国内外研究现状。第二章主要讲解了设计的主要任务与所需的关键
12、技术。第三章主要讲解了两轮自平衡小车控制系统的直立控制原理，转向控制原理。第四章主要讲解了系统的硬件设计，介绍了自平衡小车控制系统的硬件构成，主控芯片STC12C5A60S2的结构与组成，以与稳压电源模块，倾角测量模块，直流电机驱动模块，蓝牙控制模块和两轮测速模块的设计。第五章主要讲解了软件设计的算法功能与框架，主要描述了控制系统的程序实现以与PID算法的使用。第六章主要讲解了系统的调试与参数整定。最后总结与展望，总结本设计的各个模块，并对两轮自平衡小车的优化方向进展简要的阐述。2 课题任务与关键技术2.1 主要任务本文研究并设计了一种基于单片机的两轮自平衡小车控制系统，实现了两轮小车的自主直
13、立控制与蓝牙控制功能。系统采用STC12C5A60S2单片机作为核心控制单元，通过增加各种传感器，设计相应电路并编写相应程序完成平衡控制与蓝牙控制。系统需要利用加速度计和陀螺仪获得车体的倾角和角速度，并对数据进展互补滤波融合。通过编码器获得两轮的速度信息。根据获得的数据信息对速度和倾角进展闭环控制。参加蓝牙通信控制，将所有输出数据进展叠加，输出至驱动芯片，实现对小车的控制。2.2.1 系统设计两轮自平衡车的系统设计包括：车身机械结构设计，硬件系统设计和软件系统设计。在机械结构上必须保持小车重心的稳定性，才能防止控制系统过于复杂；硬件系统必须包含自平衡车所需的所有电子系统与电气设备；软件系统如此
14、负责车身平衡控制与目标效果的实现。2.2.2 数学建模模型的建立有助于控制器的设计，以与控制系统各项参数的大概确定。模型的建立主要使用牛顿力学定律。 两轮自平衡车是一个本质不平衡的系统，控制系统对小车的准确控制依赖于姿态检测系统对车身姿态与运动状态的准确检测。目前，一般采用由陀螺仪和加速度计等惯性传感器组成的姿态检测系统对车身倾角进展实时、准确的检测。但是由于惯性传感器自身固有的特性，随着温度、震动等外界变化，会产生不同程度的噪声与漂移，因此必须采用一些滤波算法，对加速度计和陀螺仪所采集的数据进展融合，使测量角度更加真实稳定。2.2.4 控制算法两轮自平衡车所实现的平衡是一种动态的平衡。在遇到
15、外界干扰时，需要通过控制算法来快速将小车恢复至平衡状态。传统的PID算法在各类工业场合有着广泛的应用，完全可以满足本控制系统的要求，因此本控制系统设计采用PID控制算法。3 系统原理分析3.1 控制系统任务分解根据系统要求，小车必须能够在没有外界干预的情况下依靠两个同轴安装的车轮保持平衡，并完成前进，后退，左右转等动作。相对于四轮车，控制系统的任务更为复杂，为了能解决该问题，首先将复杂的问题分解成简单的几个问题进展讨论。对系统要求进展分析，可知维持小车直立，并在受到外界干扰后迅速恢复稳态，完全依赖于一对直流电机对车轮的驱动。因此本控制系统的设计可以从对电机的控制着手，控制电机的转速以与转向来实现对小车的控制。小车的控制任务可以分解成以下三个根本任务：（1） 控制小车直立：通过控制两个电机的转向保持小车的直立状态。（2） 控制小车车速：通过控制两个电机的转速实现车速控制。（3） 控制小车转向：通过控制两个电机的转速差实现转向控制。以上三个任务都是通过控制小车两个车轮的驱动电机完成的。直流电机的控制最终取决于电机两端输入的电压大小，将电机近似认为处于线性状态，因此上述三个根本任务可以等效成三种不同控制目标的电压，将这三种电压进展叠加后，便可以得到最终所需
