两轮自平衡小车
1简介
两轮自平衡小车是一种特殊轮式移动机器人,其动力学系统具有多变量、非线性、强耦合、参数不确定等特性。是一个集动态决策和规划、环境感知、行为控制和执行等多种功能于一体的综合复杂系统，其关键是在解决自平衡的同时，还能够适应在各种环境下的控制任务。通过运用外加速度传感器、角速度传感器等，可以实现小车的平衡自主前进。两轮自平衡小车，涉及到传感器的驱动，数据的处理，角度的计算，电机的控制等，内容比较丰富。
其原理看似简单，但谁都不能小看它，它绝对当得上“精妙”二字。近年来它的应用已较为普遍，研究也较为深刻。由于它具有体积小、运动灵活、零转弯半径等特点，将会在军用和民用领域有着广泛的应用前景。因为它既有理论研究意义又有实用价值，所以两轮自平衡小车的研究在最近十年引起了大量机器人技术实验室的广泛关注。
2 基本原理
2.1 基本构想
两轮自平衡小车共分三种运动状态：
（1）前倾状态：即车身重心靠前，车身会向前倾斜，则驱动车轮向前滚动，以保持小车平衡。
（2）静止状态：即车身重心位于电机轴心线的正上方，则小车将保持动态平衡静止状态，不需要做任何控制。
（3）后仰状态：即车身重心靠后，车身会向后倾斜，则驱动车轮向后滚动，以保持小车平衡。
（4）因此，两轮自平衡小车平衡控制的基本思想是：是系统以姿态传感器(陀螺仪、加速度计)来监测车身所处的俯仰状态和状态变化率，通过高速中央处理器计算出适当数据和指令后，控制系统会根据测得的倾角产生一个相应的力矩，通过控制电机驱动两个车轮朝车身要倒下的方向运动，以保持小车自身的动态平衡。其图如下；
（1）前倾（2）静止（3）后仰
2.2 硬件结构原理
自动化设备简单说来主要由三部分组成：传感器、控制器、执行器。两轮自平衡小车也是由这三部分组成。其结构原理如下：
此外通常会加上硬件抗干扰措施。
3 主要结构部件
3.1 传感器
为了实现两轮小车的自平衡，需要快速、准确地获得机器人的位置与姿态信息，这是控制两轮自平衡小车平衡与运动的前提条件，为此我们需要传感器。对于小车姿态检测而言，我们一般采用惯性传感器。一般常用的惯性传感器有加速度计、陀螺仪以及倾斜传感器。而三种传感器各有优缺点，综合经济、实用等方面的考虑，我们选用加速度计和陀螺仪。下面是两种传感器基本信息的比较：
综合上述信息，两者加起来是最优搭配，具有互补作用。
此外我们还要添加一个光电编码器。编码器的主要作用是采集车轮的运动信息，以便微控制器的决策；光电编码器用以检测小车的位移，同时对位移求导可以得到小车的速度。但一般来说电机中自带的霍尔元件也有部分功能。
3.2 控制器
要做到准确的控制，要有优秀的硬件及驱动线路和同样优秀的算法软件。
图3-1电机控制原理图
其中的细节部分不再展开来讲。
再者就是软件算法。算法是计算机的灵魂，因此算法在此两轮自平衡小车中也是起到灵魂的作用。这一部分很复杂，只能简单讲诉。它主要是PID技术，就是将偏差的比例(Proportional)、积分(Integral)和微分(Differential)通过线性组合构成控制量，用这一控制量对被控对象进行控制。详情略。
3.3执行器
主要采用直流无刷电机。相较于普通直流有刷电机，它具有普通直流有刷电机的所有优点，而且由于没有换向器和电刷，可靠性高，寿命长，能够很好的满足两轮自平衡机器人的要求。直流无刷电机具有线性机械特性、调速范围宽、大气动转矩、效率较高和控制电路简单等优点。
3.4硬件抗干扰措施
在电机调速系统中，各种电磁干扰（EMI)相当强烈。对于干扰源，要尽量消除，不能消除的，则要通过隔离、滤波等措施，尽量减弱其发出的干扰信号的强度；对于干扰信号的耦合通道，要切断或采用滤波、选频、屏蔽等技术进行抑制；对于对干扰信号敏感的电路或元件，要采用合理接地和退藕、滤波等措施提高电路或元件的抗干扰能力.
4 总结
两轮自平衡小车已经有较普遍的应用，在我们身边也可以看到很多两轮自平衡小车的玩具。但仅仅只是玩具的制造，真是大材小用了，我们要把它应用到更广的、更实用的领域上，运用到实际的生产制造，让我们生活更美好。
最近，EEPW电子产品世界有一个DIY自平衡小车的比赛，可以申请经费，最后评奖还发放奖金，也是挺有意义的。
常熟理工学院学报（自然科学）Journal of Changshu Institute Technology （Natural Sciences ）第26卷第10Vol.26No.102012年10月Oct.,2012 收稿日期：2012-09-07 基金项目：江苏省大学生实践创新训练计划项目“两轮自平衡机器小车的设计”（jx110152011） 作者简介：李荣伟（1989—），男，江苏东海人，常熟理工学院电气与自动化工程学院测控技术与仪器专业2009级学生. 通讯作者：李鑫（1983—），男，安徽亳州人，实验师，硕士，研究方向：智能控制技术与现代检测技术，E-mail:lixin_yy@https://www.doczj.com/doc/8617002598.html,．两轮自平衡小车的设计 李荣伟，李鑫，孙传开，张冬林，江振峰 （常熟理工学院电气与自动化工程学院，江苏常熟215500） 摘要：设计了以陀螺仪ENC-03以及MEMS 加速度计MMA7260为传感器的姿态感知系统， 选用16位单片机MC9S12XS128为控制核心处理器，完成对传感器信号的采集处理、车身控制以及人机交互的设计，实现小车自主控制平衡状态、运行速度以及转向角度大小等功能.实验结果表明该系统的性能满足设计要求. 关键词：两轮自平衡；姿态检测；卡尔曼滤波；数据融合；PID 控制器 中图分类号：TP242.6文献标识码：A 文章编号：1008-2794（2012）10-0070-06 近年来，随着电子技术的发展与进步，移动机器人的研究已成为目前科学研究最活跃的领域之一，移动机器人经常会遇到在较为狭窄复杂的环境中如何灵活快捷地执行任务的问题.两轮自平衡机器人的概念就是在此背景下提出来的，这种机器人区别于其他移动机器人最显著的特点是：采用了两轮共轴、各自独立驱动的工作方式（又称差分式驱动），车身的重心位于车轮轴的上方，通过轮子的前后移动保持车身的平衡、行驶[1].因为具有体积小、运动灵活、零转弯半径等特点，所以在军用和民用领域有着广泛的应用前景，更重要的是系统具有多变量、非线性、强耦合、不稳定性的特性，使其成为很好地验证控制理论及方法的平台，具有很高的研究价值. 1系统整体设计 本文设计的自平衡车采用姿态传感器（加速度计和陀螺 仪）监测车身所处的俯仰状态和状态变化率，通过高速微控制 器（MC9S12XS128）完成数据融合处理，得到平滑而稳定车体 姿态信息，然后驱动电动机产生前进或后退的加速度来控制 车体保持平衡，同时系统还要根据速度的反馈量来完成对车 体速度和方向的控制，微控制器还需构建相关输入输出模块 和人机交互设备.系统设计总体结构框图如图1所示. 已知自平衡车高度为l ，质量为m ，将其抽象为一级倒立 摆，并将倒立摆置于可水平移动的小车上.假设其受外力干图1系统设计总体结构框图
两轮自平衡小车控制系统的设计 摘要：介绍了两轮自平衡小车控制系统的设计与实现，系统以飞思卡尔公司的16位微控制器MC9S12XS128MAL作为核心控制单元，利用加速度传感器MMA7361测量重力加速度的分量，即小车的实时倾角，以及利用陀螺仪ENC-03MB测量小车的实时角速度，并利用光电编码器采集小车的前进速度，实现了小车的平衡和速度控制。在小车可以保持两轮自平衡前提下，采用摄像头CCD-TSL1401作为路径识别传感器，实时采集赛道信息，并通过左右轮差速控制转弯，使小车始终沿着赛道中线运行。实验表明，该控制系统能较好地控制小车平衡快速地跟随跑道运行，具有一定的实用性。 关键词：控制；自平衡；实时性 近年来，随着经济的不断发展和城市人口的日益增长，城市交通阻塞以及耗能、污染问题成为了一个困扰人们的心病。新型交通工具的诞生显得尤为重要，两轮自平衡小车应运而生，其以行走灵活、便利、节能等特点得到了很大的发展。但是，昂贵的成本还是令人望而止步，成为它暂时无法广泛推广的一个重要原因。因此，开展对两轮自平衡车的深入研究，不仅对改善平衡车的性价比有着重要意义，同时也对提高我国在该领域的科研水平、扩展机器人的应用背景等具有重要的理论及现实意义。全国大学生飞思卡尔智能车竞赛与时俱进，第七届电磁组小车首次采用了两轮小车，模拟两轮自平衡电动智能车的运行机理。在此基础上，第八届光电组小车再次采用两轮小车作为控制系统的载体。小车设计内容涵盖了控制、模式识别、传感技术、汽车电子、电气、计算机、机械及能源等多个学科的知识。 1 小车控制系统总体方案 小车以16位单片机MC9S12XS128MAL作为中央控制单元，用陀螺仪和加速度传感器分别检测小车的加速度和倾斜角度[1]，以线性CCD采集小车行走时的赛道信息，最终通过三者的数据融合，作为直流电机的输入量，从而驱动直流电机的差速运转，实现小车的自动循轨功能。同时，为了更方便、及时地观察小车行走时数据的变化，并且对数据作出正确的处理，本系统调试时需要无线模块和上位机的配合。小车控制系统总体架构。 2 小车控制系统自平衡原理 两轮小车能够实现自平衡功能，并且在受到一定外力的干扰下，仍能保持直立状态，是小车可以沿着赛道自动循线行走的先决条件。为了更好地控制小车的行走方式，得到最优的行走路径，需要对小车分模块分析与控制。 本控制系统维持小车直立和运行的动力都来自小车的两个轮子，轮子转动由两个直流电机驱动。小车作为一个控制对象，它的控制输入量是两个电机的转动速度。小车运动控制可以分解成以下3个基本控制任务。 （1）小车平衡控制：通过控制两个电机正反方向运动保持小车直立平衡状态； （2）小车速度控制：通过调节小车的倾斜角度来实现小车速度控制，本质上是通过控制电机的转速来实现小车速度的控制。 （3）小车方向控制：通过控制两个电机之间的转动差速实现小车转向控制。 2.1 小车平衡控制 要想实现小车的平衡控制，需要采取负反馈控制方式[2]。当小车偏离平衡点时，通过控制电机驱动电机实现加、减速，从而抵消小车倾斜的趋势，便可以保持车体平衡。即当小车有向前倾的趋势时，可以使电机正向加速，给小车一个向前的加速度，在回复力和阻尼力的作用下，小车不至于向前倾倒；当小车有向后倾的趋势时，可以使小车反向加速，给小车一个向后的加速度，从而不会让小车向后倾倒，。
两轮自平衡小车毕业设计毕业论文 目录 1.绪论 (1) 1.1研究背景与意义 (1) 1.2两轮自平衡车的关键技术 (2) 1.2.1系统设计 (2) 1.2.2数学建模 (2) 1.2.3姿态检测系统 (2) 1.2.4控制算法 (3) 1.3本文主要研究目标与内容 (3) 1.4论文章节安排 (3) 2.系统原理分析 (5) 2.1控制系统要求分析 (5) 2.2平衡控制原理分析 (5) 2.3自平衡小车数学模型 (6) 2.3.1两轮自平衡小车受力分析 (6) 2.3.2自平衡小车运动微分方程 (9) 2.4 PID控制器设计 (10) 2.4.1 PID控制器原理 (10) 2.4.2 PID控制器设计 (11) 2.5姿态检测系统 (12) 2.5.1陀螺仪 (12) 2.5.2加速度计 (13) 2.5.3基于卡尔曼滤波的数据融合 (14) 2.6本章小结 (16) 3.系统硬件电路设计 (17) 3.1 MC9SXS128单片机介绍 (17) 3.2单片机最小系统设计 (19) 3.3 电源管理模块设计 (21) I
3.4倾角传感器信号调理电路 (22) 3.4.1加速度计电路设计 (22) 3.4.2陀螺仪放大电路设计 (22) 3.5电机驱动电路设计 (23) 3.5.1驱动芯片介绍 (24) 3.5.2 驱动电路设计 (24) 3.6速度检测模块设计 (25) 3.6.1编码器介绍 (25) 3.6.2 编码器电路设计 (26) 3.7辅助调试电路 (27) 3.8本章小结 (27) 4.系统软件设计 (28) 4.1软件系统总体结构 (28) 4.2单片机初始化软件设计 (28) 4.2.1锁相环初始化 (28) 4.2.2模数转换模块（ATD）初始化 (29) 4.2.3串行通信模块（SCI）初始化设置 (30) 4.2.4测速模块初始化 (31) 4.2.5 PWM模块初始化 (32) 4.3姿态检测系统软件设计 (32) 4.3.1陀螺仪与加速度计输出值转换 (32) 4.3.2卡尔曼滤波器的软件实现 (34) 4.4平衡PID控制软件实现 (36) 4.5两轮自平衡车的运动控制 (37) 4.6本章小结 (39) 5. 系统调试 (40) 5.1系统调试工具 (40) 5.2系统硬件电路调试 (40) 5.3姿态检测系统调试 (41) 5.4控制系统PID参数整定 (43) II
基于单片机的两轮自平衡车控制系统设计 摘要 两轮自平衡车是一种高度不稳定的两轮机器人，就像传统的倒立摆一样，本质不稳定是两轮小车的特性，必须施加有效的控制手段才能使其稳定。本文提出了一种两轮自平衡小车的设计方案，采用重力加速度陀螺仪传感器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
燕山大学 课程设计说明书题目：双轮自平衡小车机器人系统设计与制作 学院（系）：机械工程学院 年级专业：12级机械电子工程 组号：3 学生： 指导教师：史艳国建涛艳文史小华庆玲 唐艳华富娟晓飞正操胡浩波 日期： 2015.11
燕山大学课程设计（论文）任务书院（系）：机械工程学院基层教学单位：机械电子工程系
摘要 两轮自平衡小车是一种非线性、多变量、强耦合、参数不确定的复杂系统，他体积小、结构简单、运动灵活，适合在狭小空间工作，是检验各种控制方法的一个理想装置，受到广大研究人员的重视，成为具有挑战性的课题之一。 两轮自平衡小车系统是一种两轮左右并行布置的系统。像传统的倒立一样，其工作原理是依靠倾角传感器所检测的位姿和状态变化率结合控制算法来维持自身平衡。本设计通过对倒立摆进行动力学建模，类比得到小车平衡的条件。从加速度计和陀螺仪传感器得出的角度。运用卡尔曼滤波优化，补偿陀螺仪的漂移误差和加速度计的动态误差，得到更优的倾角近似值。通过光电编码器分别得到车子的线速度和转向角速度，对速度进行PI控制。根据PID控制调节参数，实现两轮直立行走。通过调节左右两轮的差速实现小车的转向。 制作完成后，小车实现了在无线蓝牙通讯下前进、后退、和左右转向的基本动作。此外小车能在正常条件下达到自主平衡状态。并且在适量干扰下，小车能够自主调整并迅速恢复稳定状态。 关键词：自平衡陀螺仪控制调试
前言 移动机器人是机器人学的一个重要分支，对于移动机器人的研究，包括轮式、腿式、履带式以及水下式机器人等，可以追溯到20世纪60年代。移动机器人得到快速发展有两方面原因：一是其应用围越来越广泛；二是相关领域如计算、传感、控制及执行等技术的快速发展。移动机器人尚有不少技术问题有待解决，因此近几年对移动机器人的研究相当活跃。 近年来，随着移动机器人研究不断深入、应用领域更加广泛，所面临的环境和任务也越来越复杂。机器人经常会遇到一些比较狭窄，而且有很多大转角的工作场合，如何在这样比较复杂的环境中灵活快捷的执行任务，成为人们颇为关心的一个问题。双轮自平衡机器人概念就是在这样的背景下提出来的。两轮自平衡小车是一个高度不稳定两轮机器人，是一种多变量、非线性、强耦合的系统，是检验各种控制方法的典型装置。同时由于它具有体积小、运动灵活、零转弯半径等特点，将会在军用和民用领域有着广泛的应用前景。因为它既有理论研究意义又有实用价值，所以两轮自平衡小车的研究在最近十年引起了大量机器人技术实验室的广泛关注。 本论文主要叙述了基于stm32控制的两轮自平衡小车的设计与实现的整个过程。主要容为两轮自平衡小车的平衡原理，直立控制，速度控制，转向控制及系统定位算法的设计。通过此设计使小车具备一定的自平衡能力、负载承载能力、速度调节能力和无线通讯功能。小车能够自动检测自身机械系统的倾角并完成姿态的调整，并在加载一定重量的重物时能够快速做出调整并保证自身系统的自我平衡。能够以不同运动速度实现双轮车系统的前进、后退、左转与右转等动作，同时也能够实现双轮自平衡车系统的无线远程控制操作
2012年省电子竞赛设计报告 项目名称：自平衡小车 姓名：连文金、林冰财、陈立镔 指导老师：吴进营、苏伟达、李汪彪、何志杰日期：2012年9月7日
摘要： 本组的智能小车底座采用的是网上淘宝的三轮两个电机驱动的底座,主控芯片为STC89C52,由黑白循迹采集模块对车道信息进行采集,将采集的信息传送到主控芯片,再由主控芯片发送相应的指令到电机驱动模块L298N，从而控制电机的运转模式。 关键词： STC89C52 L298N 色标传感器 E18-F10NK 自动循迹 引言： 近现代，随着电子科技的迅猛发展，人们对技术也提出了更高的要求。汽车的智能化在提高汽车的行驶安全性，操作性等方面都有巨大的优势，在一些特殊的场合下也能满足一些特殊的需要。智能小车系统涉及到自动控制，车辆工程，计算机等多个领域，是未来汽车智能化是一个不可避免的大趋势。本文设计的小车以STC89C52为控制核心，用色标传感器 E18-F10NK作为检测元件实现小车的自动循迹前行。 一、系统设计 本组智能小车的硬件主要有以STC89C52 作为核心的主控器部分、自动循迹部分、电机驱动部分。 1.1方案论证及选择： 根据设计要求，可以有多种方法来实现小车的功能。我们采用模块化思想，从各个单元电路选择入手进行整体方案的论证、比较与选择。 本方案以STC89C52作为主控芯片，通过按键进行模式的选择切换，按键一选择三轮循迹，按键二进行两轮循迹。 1.1.1模式一（三轮循迹）： 模式一（按键一控制）：三轮循迹的时候，通过色标传感器和激光传感器进行实时的数据采集，反馈给主控芯片，主控芯片通过驱动L298来控制两路直流减速电机，从而保证路线的准确性。
中北大学 课程设计说明书 学生姓名: *杰学号：* 学院: 仪器与电子学院 专业: * 题目: 基于ARM的两轮自平衡车模型系统设计 指导教师：李锦明职称: 副教授 2015 年1 月30 日
摘要 近年来，两轮自平衡车的研究与应用获得了迅猛发展。本文提出了一种两轮自平衡小车的设计方案，采用陀螺仪L3G4200以及MEMS加速度传感器MMA7260构成小车姿态检测装置，使用卡尔曼滤波完成陀螺仪数据与加速度计数据的数据融合。系统选用飞思卡尔32位单片机Kinetis K60为控制核心，通过滤波算法实现车身控制，人机交互等。 整个系统制作完成后，各个模块能够正常并协调工作，小车可以在无人干预条件下实现自主平衡。同时在引入适量干扰情况下小车能够自主调整并迅速恢复稳定状态。 关键词：两轮自平衡陀螺仪姿态检测卡尔曼滤波数据融合
目录 1 课程设计目的 (1) 2 设计内容和要求 (1) 2.1 设计要求 (1) 2.2 研究意义 (1) 2.3 研究内容 (2) 3 设计方案及实现情况 (2) 3.1 两轮平衡车的平衡原理 (2) 3.2 系统方案设计 (3) 3.3 系统最终方案 (6) 3.4 系统软件设计 (9) 3.5 电路调试 (16) 4 课程设计总结 (18) 参考文献 (19) 附录 (20) 致谢 (21)
1 课程设计目的 （1）掌握嵌入式系统的一般设计方法和设计流程； （2）学习嵌入式系统设计，掌握相关IDE开发环境的使用方法； （3）掌握ARM的应用； （4）学习掌握嵌入式系设计的全过程； 2 设计内容和要求 2.1 设计要求 （1）学习掌握基于ARM Cortex-M4内核的Kinetis K60系列单片机的工作原理及应用；（2）学习掌握加速度计、陀螺仪的工作原理及应用； （3）设计基于PID控制的两轮自平衡车模型系统的工作原理图及PCB版图； 2.2 研究意义 近年来，随着电子技术的发展与进步，移动机器人的研究不断深入，成为目前科 学研究最活跃的领域之一，移动机器人的应用范围越来越广泛，面临的环境和任务也 越来越复杂，这就要求移动机器人必须能够适应一些复杂的环境和任务。比如，户外 移动机器人需要在凹凸不平的地面上行走，有时环境中能够允许机器人运行的地方比 较狭窄等。如何解决机器人在这些环境中运行的问题，逐渐成为研究者关心的问题[1]。 两轮自平衡机器人的概念正是在这样一个背景下提出来的，这种机器人区别于其 他移动机器人的最显著的特点是：采用了两轮共轴、各自独立驱动的工作方式(这种驱 动方式又被称为差分式驱动方式)，车身的重心位于车轮轴的上方，通过轮子的前后移 动来保持车身的平衡，并且还能够在直立平衡的情况下行驶。由于特殊的结构，其适 应地形变化能力强，运动灵活，可以胜任一些复杂环境里的工作。 两轮自平衡机器人自面世以来，一直受到世界各国机器人爱好者和研究者的关 注，这不仅是因为两轮自平衡机器人具有独特的外形和结构，更重要的是因为其自身 的本质不稳定性和非线性使它成为很好的验证控制理论和控制方法的平台，具有很高 的研究价值。
双轮自平衡车设计报告 学院………….......... 班级…………………… 姓名………………..手机号…………………..姓名………………..手机号…………………..姓名………………..手机号…………………..
目录 一、双轮自平衡车原理 二、总体方案 三、电路和程序设计 四、算法分析及参数确定过程
一.双轮自平衡车原理 1.控制小车平衡的直观经验来自于人们日常生活经验。一般的人通过简单练习就可以让一个直木棒在手 指尖上保持直立。这需要两个条件：一个是托着木棒的手掌可以移动；另一个是眼睛可以观察到木棒的倾斜角度和倾斜趋势（角速度）。通过手掌移动抵消木棒的倾斜角度和趋势，从而保持木棒的直立。这两个条 件缺一不可，让木棒保持平衡的过程实际上就是控制中的负反馈控制。 图1 木棒控制原理图 2.小车的平衡和上面保持木棒平衡相比，要简单一些。因为小车是在一维上面保持平衡的，理想状态下，小车只需沿着轮胎方向前后移动保持平衡即可。 图2 平衡小车的三种状态 3.根据图2所示的平衡小车的三种状态，我们把小车偏离平衡位置的角度作为偏差；我们的目标是通过 负反馈控制，让这个偏差接近于零。用比较通俗的话描述就是：小车往前倾时车轮要往前运动，小车往后倾时车轮要往后运动，让小车保持平衡。 4.下面我们分析一下单摆模型，如图4所示。在重力作用下，单摆受到和角度成正比，运动方向相反的回复力。而且在空气中运动的单摆，由于受到空气的阻尼力，单摆最终会停止在垂直平衡位置。空气的阻尼力与单摆运动速度成正比，方向相反。 图4 单摆及其运动曲线
类比到我们的平衡小车，为了让小车能静止在平衡位置附近，我们不仅需要在电机上施加和倾角成正比的回复力，还需要增加和角速度成正比的阻尼力，阻尼力与运动方向相反。 5 平衡小车直立控制原理图 5.根据上面的分析，我们还可以总结得到一些调试的技巧：比例控制是引入了回复力；微分控制是引入了阻尼力，微分系数与转动惯量有关。 在小车质量一定的情况下，重心位置增高，因为需要的回复力减小，所以比例控制系数下降；转动惯量变大，所以微分控制系数增大。在小车重心位置一定的情况下，质量增大，因为需要的回复力增大，比例控制系数增大；转动惯量变大，所以微分控制系数增大。 二.总体方案 ■小车总框图
2015年陇东学院第十六届“挑战杯” 课外学术科技作品竞赛 双轮自平衡小车的设计与制作 学院：电气工程学院 班级：12级自动化本科班 姓名：周永 2015年12月8日
双轮自平衡小车的设计与制作 摘要：双轮自平衡小车是一个集动态决策和规划、环境感知、行为控制和执行等多种功能于一体的综合复杂系统，其关键是在解决自平衡的同时，还能够适应在各种环境下的控制任务。通过运用外加速度传感器、角速度传感器等，可以实现小车的平衡自主前进。双轮自平衡小车，涉及到传感器的驱动，数据的处理，角度的计算，电机的控制等，内容比较丰富，可作为实践自动控制原理及单片机技术的一个不错选择，是自我锻炼的绝好选题，对于以后制作此方面的民用产品也有很大的启迪作用。 关键词：双轮；自平衡；控制；传感器 1.引言 目前市场上的各种电子产品及家电机器人等行业越来越多地用到了智能控制技术。可以说，当今社会是一个智能型社会。各方各面都在竭尽全力向着智能方向发展，不论是人工智能还是联网智能，都在突出一个智能。智能已经覆盖了我们生活的方方面面，我们正在被智能的概念所潜移默化。不论是智能手机、玩具还是机器人，都已经成了我们生活的一部分。正是在这种情况下，智能交通的发展也发生了翻天覆地的变化，从飞车到自动驾驶汽车，无不在向我们说明，现代人已经对智能型交通工具期待已久了。作为最新科技产品的一个代表，最近市场上新出现的独轮车越来越受到了消费者的青睐。可以想象，最近几年内此类产品将会在市场上争得一席之地。比起独轮车，两轮车具有同样的购买热度，但是设计难度却没那么高，所以我将选择了从双轮车开始玩起智能交通工具。 2设计方案 方案一：用51单片机作为主控制器,用MPU6050模块采集姿态数据，用光电编码器对5V直流电机进行编码，显示模块采用LCD12864液晶屏，电源采用三端稳压方案，用红外遥控控制小车行走。本设计简单廉价，然而由于主控的反应相对缓慢，很难满足设计要求。 方案二：采用STM32单片机作主控制器，仍然用MPU6050模块作姿态数据采集，而电机采用二手的型号为16G214E MR19的具有高精度霍尔编码器的原价2000+的瑞士进口12V直流电机，显示模块采用了更轻薄更清晰更小巧的
两轮自平衡小车设计 一、任务要求 图1两轮自平衡车 两轮自平衡车结构原理如图1所示，主控制器（DSP）通过采集陀螺仪和加速度传感器得到位置信号，通过控制电机的正反转实现保持小车站立。 1、通过控制两个电机正反运动，实现小车在原地站立。 2、实现小车的前进、后退、转弯、原地旋转、停止等运动； 二、方案实现 2.1电机选型 图2直流电机 两轮自平衡车由于需要时刻保持平衡，对于倾角信号做出快速响应，因此对电机转矩要求较大。在此设计中选用国领电机生产的直流电机，其产品型号为GB37Y3530，工作电压6v-12v。为增大转矩，电机配有1:30传动比的减速器。
2.2电机测速方案 图3霍尔测速传感器 在电机测速方案上主流的方案有两种，分别是光电编码器和霍尔传感器。光电编码器测量精度由码盘刻度决定，刻度越多精度越高；霍尔传感器精度由永磁体磁极数目决定，同样是磁极对数越高精度越高。由于两轮自平衡车工作于剧烈震动环境中，光电编码器不适应这种环境，因此选用霍尔传感器来测量速度。电机尾部加装双通道霍尔效应编码器，AB双路输出,单路每圈脉冲16CPR,双路上下沿共输出64CPR，配合1:30的减速器传动比，可以计算出车轮转动一圈输出的脉冲数目为64X30=1920CPR，完全符合测速要求。 2.3电机驱动控制系统概述 本平台电机驱动采用全桥驱动芯片L298N，内部包含4通道逻辑驱动电路，两个H-Bridge的高电压、大电流双全桥式驱动器。本驱动桥能驱动46V、2A 以下的电机。其输出可以同时控制两个电机的正反转，非常适合两轮自平衡车开发，其原理图如下图所示 图4L298N原理图 采用脉宽调制方式（即PWM，Pulse Width Modulation）来调整电机的转速和转向。脉宽调制是通过改变发出的脉冲宽度来调节输入到电机的平均电
基于PID控制两轮自平衡小车设计
目录 1.方案设计论证 (3) 1.1单片机的选择与论证 (3) 1.2显示模块的选择与论证 (3) 1.3按键模块的选择与论证 (4) 1.5电机模块的选择与论证 (5) 2.硬件设计 (5) 2.1微控制模块设计与分析.................................................................. 错误！未定义书签。 2.2传感器模块设计与分析.................................................................. 错误！未定义书签。 2.3显示器模块设计与分析.................................................................. 错误！未定义书签。 2.4按键模块设计与分析...................................................................... 错误！未定义书签。 2.5电源模块设计与分析...................................................................... 错误！未定义书签。 3.特色创新 (5) 4.总结 (7) 参考文献 (8)
两轮自平衡小车设计 摘要：以Kinetis_K60微处理器单片机作为控制核心，通过PID算法，利用陀螺仪，摄像头、加速度计、编码器和液晶显示器等元件，设计了此两轮自平衡控制小车，实现了小车的自动平衡。该系统的创新主要体现在可以自动循迹，实时的显示周围环境的温度及小车行驶速度，以便用户可以了解当时的温度和小车的速度。该系统的主要特点是方便，快捷，环保。 关键词：Kinetis_K60微处理器，PID,陀螺仪，加速度计，液晶显示器 Abstract：We use Kinetis_K60 micro processor control with micro controller as the core,through the PID algorithm, using gyroscopes, cameras, accelerometers, encoders and LCD monitors and other components,designed the two-wheeled self-balancing control car to achieve as elf-balancing car.Innovation is mainly reflected in the system can automatically tracking, real-time display of temperature and speed of the car with the surrounding environment,so that users can under stand the prevailing temperature and the speed of the car.The main features of the system is easy, fast and environmentally friendly. Keyword：Kinetis_K60 micro processor PID algorithm accelerometers 就目前市场上的小车来说，结构过于普通，而且大部分是通过四轮同时着地行走的，同时不够智能和人性化，所以我们设计了两轮自平衡控制小车。 1.方案设计论证 1.1单片机的选择与论证 方案一：凌阳公司的16位单片机。 该单片机是16位控制器，具有体积小、驱动能力强、可靠性高、功耗低、结构简单、具有语音处理、运算速度快等优点，但凌阳公司的单片机编程规则与传统的单片机大不相同，并且IO口数量相对于其他单片机来说较少。 方案二：ATMEL公司的AT89s52作为系统的控制器。 AT89s52单片机软件编程灵活，自由度大，可用软件编程实现各种算法和逻辑控制，成本低，被各个领域广泛应用。但是51系列单片机RAM、ROM等资源少，外围模块少，指令周期长。 方案三：Kinetis_K60微处理器。 Kinetis_K60微处理器，它具有144个I/O管脚，此处理器具有高速的处理速度和丰富的I/O管脚，可以作为整个小车的控制核心。 经过综合考虑，我们选择方案三。 1.2显示模块的选择与论证 方案一：采用LED数码管显示。 LED数码管显示虽然具有亮度高，醒目，价格便宜，寿命长；但是只能显示0～9的数字和一些简单的字符，电路复杂，占用资源较多且信息量小。 方案二：用12864液晶显示。 其优点是能显示更多的字符，功耗低，体积小，且有着良好的人机界面，能够实时的反映出系统当前的状态。 方案三：采用Nokia5110液晶显示。
基于单片机的两轮自平衡车控制系统设计 文件排版存档编号：[UYTR-OUPT28-KBNTL98-UYNN208]
基于单片机的两轮自平衡车控制系统设计 摘要 两轮自平衡车是一种高度不稳定的两轮机器人，就像传统的倒立摆一样，本质不稳定是两轮小车的特性，必须施加有效的控制手段才能使其稳定。本文提出了一种两轮自平衡小车的设计方案，采用重力加速度陀螺仪传感器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
两轮自平衡车系统的设计 【摘要】两轮自平衡小车是一个集传感器系统、控制系统和推进系统于一体的机器人，通过多种传感器进行加速度、角度等数据采集、读取、处理后，将数据发送给控制器，由控制器控制电机的输出速度和转矩，让车体保持平衡，并能够按照操作者的意图前进、后退或转弯。 【关键词】自平衡车；传感器；控制器 0.引言 两轮自平衡小车是一个高度不稳定两轮机器人，是一种多变量、非线性、强耦合的系统，是检验各种控制方法的典型装置。同时由于它体积小、运动灵活、零转弯半径等特点，将会在军用和民用领域有着广泛的应用前景。 1.系统功能设计 维持车体直立行驶可以设计出很多的方案，本方案假设维持车体直立，运行的动力都来自于车体的两个轮子，图（1）所示为自平衡小车系统框图。两个车轮由大功率直流电机驱动。因此从控制角度来看，车体作为一个控制对象，它的控制输入量是两个电极的转动速度。车体运动控制任务可以分解成以下三个基本控制任务： （1）控制车体平衡：通过控制两个电机正反向运动保持车体直立平衡状态。 （2）控制车体速度：通过调节车体的倾角来实现车体速度控制，实际上最后还是演变成通过控制电机的转速来实现车轮速度的控制。 （3）控制车体方向：通过控制两个电机之间的转动差速来实现车模转向控制。 三个分解任务各自独立进行控制。由于最终都是对同一个控制对象进行控制，所以他们之间存在耦合。最终三个控制参量累加到一起作用到电机上。 2.系统机械设计 平衡车的整体结构主要包括车身、左右车轮、左右悬架和操纵杆。悬架和车轮之间6颗螺丝相连且可以相互转动；操纵杆则是靠2只较大的螺丝和车架固定。 3.系统硬件电路设计 3.1陀螺仪与加速计的数据采集与处理
2016年第8淛y信息疼甲文章编号=1009 -2552 (2016)08 -0025 -04 DOI：10.13274/https://www.doczj.com/doc/8617002598.html,ki.hdzj.2016. 08. 007 基于单片机的两轮平衡车设计 孙传开，罗飞 (华南理工大学自动化科学与工程学院，广州510640) 摘要：采用单片机MC9S12XS128作为控制器，结合陀螺仪ENC-03、三轴加速度计MMA7260 芯片，设计一个运行稳定、体积小、可匀速运动的两轮自平衡车。通过介绍平衡车的平衡原理、系统架构以及软硬件设计，阐明两轮自平衡车的设计要点。最后，通过系统理论分析以及实验 测试表明了这种设计方式的合理性和应用的可行性。 关键词：单片机；两轮自平衡；加速度计；陀螺仪；飞思卡尔 中图分类号：TP368. 1文献标识码：A D e s ig n o f tw o-w h e e l c a r s y s te m b a s e d o n m ic r o c o n tr o lle r S U N C h u a n-k a i，L U O F e i (School of Automation Science and Engineering，South China University of Technology，Guangzhou510640,China) Abstract ：This article mainly discusses design ol a small two-wheel sell-balancing car which can run stably in uniform motion,with microcontroller MC9S12XS128 as the controller and integrating an ENC-03 gyroscope as well as three-axis accelerometer MMA7260 chip.By introducing the balance principle of two-wheeled car control system，the overall structure of instrument and hardware as well as software design，it explains the design point of two-wheeled car control system.Finally，through the theoretical analysis and experimental tests it shows the feasibility and rationality of this design approach. Key words：microcontroller;two-wheeled car system；accelerometer；gyroscope;freescale 0引言 从交通工具到机器人研究，两轮车一直都广受 人们的关注，它不但可以大幅减少硬件成本而且对 空间以及能源的占用量也很少，具有很高的使用价 值和很大的应用前景。本文的目的就是研究设计一 种基于陀螺仪和加速度计的性能可靠，运行稳定的 两轮自平衡车。 1平衡车原理 两轮平衡车是类似倒立摆的一种非线性、自然 不稳定的系统,想要系统保持稳定需要使得系统的 重心与两个轮子保持在同一垂线上。姿态传感器可 以用来实时地获得系统的姿态信息,控制系统的角 度。本文采用的姿态传感器是陀螺仪和加速度计。 陀螺仪可以输出被测系统在某一方向上的角度 变化速率，通过对速率的积分处理可获得系统的角 度变化。由于陀螺仪易受外界噪声干扰，尤其是受温度影响时容易产生温飘，导致通过积分获得的角 度存在积累误差。所以，只使用陀螺仪是不行的。 加速度计是一种可以测量由物体运动或者地球 引力产生的加速度。图1所示为三轴加速度传感 器,在静止状态时y轴、Z轴输出为〇,*轴输出为重 力加速度g;当传感器向图1方向倾斜时，重力加速 度g就会沿着z轴方向产生一个加速度分量，当传 感器将加速度分量转换成z轴电压后，电压的大小 和倾斜角度的关系式为： AU = ^gsin^ (1)式中,为传感器输出电压，&为加速度传感器的 敏感系数，g为重力加速度，^为倾角。 事实上,当两轮车稳定时倾角变化范围很小，此 收稿日期：2015 -09 -07 基金项目：惠州产学研结合项目（2012B050013004) 作者简介：孙传开（1990 -),男，硕士研究生,研究方向为信号处理与控制。 一25—
电气电子工程学院自主创新作品 两轮平衡小车
摘要 两轮自平衡小车具有体积小、结构简单、运动灵活的特点，适用于狭小和危险的工作空间，在安防和军事上有广泛的应用前景。两轮自平衡小车是一种两轮左右平衡布置的，像传统倒立摆一样，本身是一种自然不稳定体，其动力学方程具有多变量、非线性、强耦合、时变、参数不确定性等特性，需要施加强有力的控制手段才能使其保持平衡。 本作品采用STM32单片机作为主控制器，用一个陀螺仪传感器来检测车的状态，通过dvr8800控制小车两个电机，来使小车保持平衡状态，通过2.4G模块无线通讯进行遥控来控制小车运行状态。 关键词：智能小车；单片机；陀螺仪。
目录 一．前言 (4) 一．两轮平衡车的平衡原理 (4) 2.1 平衡车的机械结构....................................................................... 错误！未定义书签。 2.2 两轮车倾倒原因的受力分析 (4) 2.3 平衡的方法 (5) 三．系统方案分析与选择论证 (5) 3.1 系统方案设计 (5) 3.1.1 主控芯片方案 (5) 3.1.2 姿态检测传感器方案 (6) 3.1.3 电机选择方案 (6) 3.2 系统最终方案 (7) 四．主要芯片介绍和系统模块硬件设计 (7) 4.1.STM32单片机简介（stm32rbt6） (7) 4.2.陀螺仪传感器 (8) 4.3．TB6612 (8) 4.4．编码器 (9) 4.5. 主控电路 (9) 4.6 电机驱动电路 (10) 五．系统软件设计 (11) 5.1 PID概述 (11) 5.2 数字PID算法 (12) 5.3 PID控制器设计 (13) 六．硬件电路 (14) 七．制作困难 (15) 八．结论 (16) 九．参考文献 (16)
毕业设计（论文） 题目两轮平衡车的设计 系（院）机电工程系 专业机械设计制造及其自动化 学号 指导教师 职称 二〇一四年六月二十日 独创声明
本人郑重声明：所呈交的毕业设计(论文)，是本人在指导老师的指导下，独立进行研究工作所取得的成果，成果不存在知识产权争议。据我所知，除文中已经注明引用的内容外，本设计（论文）不含任何其他个人或集体已经发表或撰写过的作品成果。对本文的研究做出重要贡献的个人和集体均已在文中以明确方式标明。 本声明的法律后果由本人承担。 作者签名: 二〇一二年月日 毕业设计（论文）使用授权声明 本人完全了解滨州学院关于收集、保存、使用毕业设计（论文）的规定。 本人愿意按照学校要求提交学位论文的印刷本和电子版，同意学校保存学位论文的印刷本和电子版，或采用影印、数字化或其它复制手段保存设计（论文）；同意学校在不以营利为目的的前提下，建立目录检索与阅览服务系统，公布设计（论文）的部分或全部内容，允许他人依法合理使用。 （保密论文在解密后遵守此规定） 作者签名: 二〇一二年月
两轮平衡车的设计 摘要 两轮自平衡车结合了两轮同轴、独立驱动、悬架结构和倒立摆模型的自平衡原理，是一种在微处理器控制下始终保持平衡的集智能化与娱乐性于一体的新型代步工具。整车由底盘、动力装置、控制装置和转向装置组成。 底盘采用下沉式的悬架结构，降低车身和使用者的重心减小了平衡控制难度,利用阻尼器削弱冲击力提高驾驶舒适性；控制部分由陀螺仪和加速度计作为传感器模块监测车体状态，可获得精确稳定的测量数据。同时微处理器实时处理状态数据，进而由驱动模块控制电机转动以维持车体平衡；转向操纵杆高度可调节亦可折叠，以适应不同高度人士使用又便于运输和存放；采用电池作为动力能源，当车减速或下坡时可自动回送电能更加节能。 两轮自平衡车的基本设计理念是娱乐、经济、安全、方便、节能环保。本车具有运动灵活、智能控制、操作简便等特点，同时它价格低廉、性价比高，娱乐性和适用性增强，弥补了传统观车辆的体积大、功耗多，不适于单人使用的缺点。两轮自平衡车适用范围更广，市场需求大，具有很强的市场推广价值和市场潜力。 关键词：两轮自平衡电动车，环保，结构设计，陀螺仪，控制电路。
本科毕业设计（论文） 题目 两轮自平衡小车的设计 学 院 电气与自动化工程学院 年 级 专 业 班 级 学 号 学生姓名 指导教师 职 称 论文提交日期
两轮自平衡小车的设计 摘要 近年来，两轮自平衡车的研究与应用获得了迅猛发展。本文提出了一种两轮自平衡小车的设计方案，采用陀螺仪ENC-03以及MEMS加速度传感器MMA7260构成小车姿态检测装置，使用卡尔曼滤波完成陀螺仪数据与加速度计数据的数据融合。系统选用飞思卡尔16位单片机MC9S12XS128为控制核心，完成了传感器信号的处理，滤波算法的实现及车身控制，人机交互等。 整个系统制作完成后，各个模块能够正常并协调工作，小车可以在无人干预条件下实现自主平衡。同时在引入适量干扰情况下小车能够自主调整并迅速恢复稳定状态。小车还可以实现前进，后退，左右转等基本动作。 关键词：两轮自平衡陀螺仪姿态检测卡尔曼滤波数据融合 I
Design of Two-Wheel Self-Balance Vehicle Abstract In recent years, the research and application of two-wheel self-balanced vehicle have obtained rapid development. This paper presents a design scheme of two-wheel self-balanced vehicle. Gyroscope ENC-03 and MEMS accelerometer MMA7260 constitute vehicle posture detection device. System adopts Kalman filter to complete the gyroscope data and accelerometer data fusion.，and adopts freescale16-bit microcontroller-MC9S12XS128 as controller core. The center controller realizes the sensor signal processing the sensor signal processing, filtering algorithm and body control, human-machine interaction and so on. Upon completion of the entire system, each module can be normal and to coordinate work. The vehicle can keep balancing in unmanned condition. At the same time, the vehicle can be adjusted independently then quickly restore stability when there is a moderate amount of interference. In addition, the vehicle also can achieve forward, backward, left and right turn and other basic movements. Key Words: Two-Wheel Self-Balance; Gyroscope; Gesture detection; Kalman filter; Data fusion II