基于单片机的两轮自平衡车控制系统设计

基于单片机的两轮自平衡车控制系统设计

摘要

两轮自平衡车是一种高度不稳定的两轮机器人，就像传统的倒立摆一样，本质不稳定是两轮小车的特性，必须施加有效的控制手段才能使其稳定。本文提出了一种两轮自平衡小车的设计方案，采用重力加速度陀螺仪传感器MPU-6050检测小车姿态，使用互补滤波完成陀螺仪数据与加速度计数据的数据融合。系统选用STC 公司的8位单片机STC12C5A60S2为主控制器，根据从传感器中获取的数据，经过PID算法处理后，输出控制信号至电机驱动芯片TB6612FNG，以控制小车的两个电机，来使小车保持平衡状态。

整个系统制作完成后，小车可以在无人干预的条件下实现自主平衡，并且在引入适量干扰的情况下小车能够自主调整并迅速恢复至稳定状态。通过蓝牙，还可以控制小车前进，后退，左右转。

关键词：两轮自平衡小车加速度计陀螺仪数据融合滤波 PID算法

Design of Control System of Two-Wheel Self-Balance Vehicle based on

Microcontroller

Abstract

Two-wheel self-balance vehicle is a kind of highly unstable two-wheel robot. The characteristic of two-wheel vehicle is the nature 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 using complementary filter for the data fusion of gyroscope and accelerometer. We choose an 8-bit microcontroller named STC12C5A60S2 from STC Company 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 named TB6612FNG for controlling two motors of vehicle, and keeping the vehicle in balance. After the completion 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 the 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;

Complementary filter; PID algorithm

1 绪论

自平衡小车的研究背景

近几年来，随着电子技术的发展与进步，移动机器人的研究不断深入，成为目前机器人研究领域的一个重要组成部分，并且其应用领域日益广泛，其所需适应的环境和执行的任务也更复杂，这就对移动机器人提出了更高的要求。比如，户外移动机器人需要在凹凸不平的地面上行走，有时机器人所需要运行的地方比较狭窄等。如何解决机器人在这些环境中运行的问题，已成为现实应用中所需要面对的一个问题。

两轮自平衡小车就是在这些的需求下所产生的。这种机器人相对于其他移动机器人的最显着特点是：采用了两轮共轴、各自独立驱动的方式工作，车身重心位于车轮轴上方，通过车轮的前后滚动来保持车身的动态平衡，并可以在直立平衡状态下完成前进、后退、左右转等任务。正是由于其特殊的构造，两轮自平衡小车适应地形变化的能力较强，且运动灵活，可以胜任一些复杂环境中的工作。

两轮自平衡车自面世以来，一直受到世界各国机器人爱好者和研究者的关注，这不仅是因为两轮自平衡车具有独特的外形和结构，更重要的是因为其自身的本质不稳定性和非线性使它成为很好的验证控制理论和控制方法的平台，具有很高的研究价值。

早在1987年，日本电信大学教授山藤一雄就提出了两轮自平衡机器人的概念。这个基本的概念就是用数字处理器来侦测平衡的改变，然后以平行的双轮来保持机器的平稳。

本世纪初。美国发明家狄恩·卡门与他的DEKA公司研发出了可以用于载人的两轮自平衡车，并命名为赛格威，投入市场后，引发了自平衡车的流行。由于两轮自平衡车有着活动灵活，环境无害等优点，其被广泛应用于各类高规格社会活动中，目前该车已用于奥运会、世博会、机场、火车站等大型场合。

自平衡小车研究意义

由于两轮自平衡小车具有结构特殊、体积小、运动灵活、适应地形变化能力强、能够方便的实现零半径回转、适合在拥挤和危险的空间内活动、可以胜任一些复杂环境里的工作。因此两轮自平衡车有着广泛的应用前景，其典型应用包括代步工具、通勤车、空间探索、危险品运输、高科技玩具、控制理论测试平台等方面。目前自平衡车的应用如自平衡的代步车正在流行开来。因此两轮自平衡车的研究很有意义。

论文的主要内容

本论文主要叙述了基于单片机的两轮自平衡车控制系统的设计与实现的整个过程。主要内容为两轮自平衡小车的平衡原理，直立控制，蓝牙控制。整个内容分为六章，包括绪论、课题任务与关键技术、系统原理概述、系统硬件设计、系统软件设计和系统的机械安装及调试。第一章主要讲解了课题的研究背景及意义，国内外研究现状。第二章主要讲解了设计的主要任务与所需的关键技术。第三章主要讲解了两轮自平衡小车控制系统的直立控制原理，转向控制原理。第四章主要讲解了系统的硬件设计，