|
|
EDA365欢迎您登录！
您需要 登录 才可以下载或查看，没有帐号？注册
x
两轮自平衡车是一种高度不稳定的两轮机器人，就像传统的倒立摆一样，本; }& N6 X( v0 |* r
质不稳定是两轮小车的特性， 必须施加有效的控制手段才能使其稳定。本文提出
! { w# ^. N: D, x了一种两轮自平衡小车的设计方案，采用重力加速度陀螺仪传感器MPU-6050# t; T1 C" K3 A; H) k! f
检测小车姿态， 使用互补滤波完成陀螺仪数据与加速度计数据的数据融合。系统
& e; D, |; B2 E! H: y D8 n) Z$ i4 o选用STC 公司的8 位单片机STC12C5A60S2 为主控制器，根据从传感器中获取
& ]/ d0 K( H) z: q1 i' B的数据，经过PID 算法处理后，输出控制信号至电机驱动芯片TB6612FNG，以+ p0 d8 Q+ i" i/ Y
控制小车的两个电机，来使小车保持平衡状态。
9 L& s8 u9 o$ V, {整个系统制作完成后，小车可以在无人干预的条件下实现自主平衡，并且在4 z5 D) f& p/ A
引入适量干扰的情况下小车能够自主调整并迅速恢复至稳定状态。通过蓝牙，还
0 ^$ t' @( k* o% l6 a P可以控制小车前进，后退，左右转。# x% t7 I, H& X$ ^0 y
8 G3 v1 ]! c; o, `' B! F* T8 f/ s
1 绪论
+ A% I( k9 C$ j* y: C1.1 自平衡小车的研究背景
% W3 m& c) k2 ?- x近几年来，随着电子技术的发展与进步，移动机器人的研究不断深入，成为
8 |: Y/ i% k* A0 D0 i目前机器人研究领域的一个重要组成部分， 并且其应用领域日益广泛， 其所需适
1 {0 o0 A l( s, ~+ {应的环境和执行的任务也更复杂，这就对移动机器人提出了更高的要求。比如，5 l+ [+ ?3 w8 C; M5 X
户外移动机器人需要在凹凸不平的地面上行走， 有时机器人所需要运行的地方比7 Q5 N3 b! K' ^0 k% N5 h; e% \% R! `
较狭窄等。如何解决机器人在这些环境中运行的问题， 已成为现实应用中所需要, u+ O4 U: M8 ?* G# R. ~6 Z
面对的一个问题。1 v- Q5 T+ K9 }
两轮自平衡小车就是在这些的需求下所产生的。这种机器人相对于其他移动
# u! Y+ |% Y" `机器人的最显著特点是： 采用了两轮共轴、各自独立驱动的方式工作， 车身重心
- Z! T! E3 ]$ X8 e位于车轮轴上方， 通过车轮的前后滚动来保持车身的动态平衡， 并可以在直立平
1 ^; q$ Q! J+ h ]! I衡状态下完成前进、后退、左右转等任务。正是由于其特殊的构造，两轮自平衡 X3 J9 P% B. u. J
小车适应地形变化的能力较强，且运动灵活，可以胜任一些复杂环境中的工作。3 H$ g) S' s- L$ ~2 W
两轮自平衡车自面世以来， 一直受到世界各国机器人爱好者和研究者的关注，( \/ w. V* ?- ]0 q9 v& i
这不仅是因为两轮自平衡车具有独特的外形和结构， 更重要的是因为其自身的本
" `8 w7 V& y0 L质不稳定性和非线性使它成为很好的验证控制理论和控制方法的平台， 具有很高2 m" U9 u0 o* L. K9 R1 A' ?
的研究价值。
! z- T. Z, ~7 N早在1987 年，日本电信大学教授山藤一雄就提出了两轮自平衡机器人的概' c3 C% S( L% n5 U/ S Y
念。这个基本的概念就是用数字处理器来侦测平衡的改变， 然后以平行的双轮来) ? Y+ b( h0 p6 l: ]
保持机器的平稳。
3 u* ?, Y% [; m本世纪初。美国发明家狄恩· 卡门与他的DEKA 公司研发出了可以用于载人5 h4 f ]4 q% c& o6 o2 C
的两轮自平衡车，并命名为赛格威，投入市场后，引发了自平衡车的流行。由于
) o4 M# W5 K1 }9 u1 W& p( a& H两轮自平衡车有着活动灵活， 环境无害等优点， 其被广泛应用于各类高规格社会
/ |/ k9 q: h a: @活动中，目前该车已用于奥运会、世博会、机场、火车站等大型场合。- x. M( d. s* u3 A! J4 }
1.2 自平衡小车研究意义( k! t' H" I- V0 K% j6 \& i) I
由于两轮自平衡小车具有结构特殊、体积小、运动灵活、适应地形变化能力
6 g4 D6 b$ K# _( U! c$ ]& ]9 @强、能够方便的实现零半径回转、适合在拥挤和危险的空间内活动、可以胜任一 W" A* M. P% q
些复杂环境里的工作。因此两轮自平衡车有着广泛的应用前景， 其典型应用包括
% U; C' I; O: O2 b- F& E9 o; H代步工具、通勤车、空间探索、危险品运输、高科技玩具、控制理论测试平台等
% t2 \5 [6 V6 {# K' }方面。目前自平衡车的应用如自平衡的代步车正在流行开来。因此两轮自平衡车* j# Z7 }% u- d- n: p; v* \( _# i( ]
的研究很有意义。
+ f: c$ S0 ~; Q5 `( T2
; v+ d: {7 u: W) f7 w/ e1.3 论文的主要内容
* P% S& {& x3 C( \2 F本论文主要叙述了基于单片机的两轮自平衡车控制系统的设计与实现的整
' q5 e/ t! e9 _个过程。主要内容为两轮自平衡小车的平衡原理，直立控制，蓝牙控制。整个内6 I: ]6 m1 T t
容分为六章，包括绪论、课题任务与关键技术、系统原理概述、系统硬件设计、
3 |8 H" I2 H% |7 _+ E8 e2 f! w系统软件设计和系统的机械安装及调试。第一章主要讲解了课题的研究背景及意* G5 N$ I; v O( d5 U. }1 h
义，国内外研究现状。第二章主要讲解了设计的主要任务与所需的关键技术。第& m# ~: G U2 f; @/ a( U
三章主要讲解了两轮自平衡小车控制系统的直立控制原理， 转向控制原理。第四; k h9 q& A7 m
章主要讲解了系统的硬件设计， 介绍了自平衡小车控制系统的硬件构成， 主控芯) t. }3 }2 }8 L$ Q; G# J* n6 U
片STC12C5A60S2 的结构及组成，以及稳压电源模块，倾角测量模块，直流电6 v1 C2 s2 I) h1 Q# l9 X( E
机驱动模块， 蓝牙控制模块和两轮测速模块的设计。第五章主要讲解了软件设计
& G" u' U7 w" D7 X1 w: U的算法功能与框架，主要描述了控制系统的程序实现以及PID 算法的使用。第2 H9 u1 ]/ `# }. y. t
六章主要讲解了系统的调试与参数整定。最后总结与展望， 总结本设计的各个模9 {3 D$ G* j, S; {' G. I" `/ T
块，并对两轮自平衡小车的优化方向进行简要的阐述。 i, X' ]9 n8 P& W/ Z4 i
2 课题任务与关键技术
1 d- ]8 W. ^% T! n7 P2.1 主要任务: D. a8 ~5 J1 E" @& r% t
本文研究并设计了一种基于单片机的两轮自平衡小车控制系统， 实现了两轮
& U4 d. w1 N6 X6 O/ o小车的自主直立控制与蓝牙控制功能。系统采用STC12C5A60S2 单片机作为核& E! h0 r1 e4 @; n$ a' b
心控制单元， 通过增加各种传感器， 设计相应电路并编写相应程序完成平衡控制- R$ \, R+ g! p: ?5 t% o7 C
与蓝牙控制。系统需要利用加速度计和陀螺仪获得车体的倾角和角速度， 并对数) } I9 ~) r- n8 e' N
据进行互补滤波融合。通过编码器获得两轮的速度信息。根据获得的数据信息对* ~5 x' B7 W' a2 j' t, q+ Q
速度和倾角进行闭环控制。加入蓝牙通信控制， 将所有输出数据进行叠加， 输出
* E9 p+ Y8 B2 c! p2 o, V2 q$ N至驱动芯片，实现对小车的控制。
6 k' U/ n" q1 ^0 h2.2 关键技术0 e3 D+ k% {' J1 R6 D; O+ {9 r% F7 F1 S
2.2.1 系统设计
' L! Z7 _4 `/ ^+ }4 k两轮自平衡车的系统设计包括： 车身机械结构设计， 硬件系统设计和软件系
1 {! T1 I/ u& W* ^0 H( R统设计。在机械结构上必须保持小车重心的稳定性， 才能避免控制系统过于复杂；) D- G( ~: t! v3 |
硬件系统必须包含自平衡车所需的所有电子系统与电气设备； 软件系统则负责车
# S8 k" K# u4 t2 t! l5 T身平衡控制与目标效果的实现。- C! E1 X" ~- n6 f$ ?7 G9 p
2.2.2 数学建模
+ P% [, }8 Q6 g g# Y0 h模型的建立有助于控制器的设计， 以及控制系统各项参数的大概确定。模型
1 ]4 ~3 h6 @9 M, V2 {4 G$ z3
! Q, N4 m$ Q' U! |' v) [1 G9 x8 ~; M的建立主要使用牛顿力学定律。+ T2 W# N5 A8 |& t' h. }
2.2.3 姿态检测
- a3 _# b$ ]; N' }; L* a两轮自平衡车是一个本质不平衡的系统， 控制系统对小车的精确控制依赖于' } N) ^2 V9 I- ]& W
姿态检测系统对车身姿态及运动状态的精确检测。目前，一般采用由陀螺仪和加
/ y6 [) x. ^/ r$ Z% e$ h8 c! U/ H速度计等惯性传感器组成的姿态检测系统对车身倾角进行实时、准确的检测。但
: r' b" N' e" ~# z; D是由于惯性传感器自身固有的特性， 随着温度、震动等外界变化， 会产生不同程
, [% C8 `# x9 V度的噪声与漂移， 因此必须采用一些滤波算法， 对加速度计和陀螺仪所采集的数2 Y# j; P4 V8 p- O7 A
据进行融合，使测量角度更加真实稳定。
& ]. W/ D0 ?+ p2.2.4 控制算法
" K `6 h+ O- Z7 f* c两轮自平衡车所实现的平衡是一种动态的平衡。在遇到外界干扰时， 需要通
6 T( S" J, L* q' D6 ~# T, T' t% ?过控制算法来快速将小车恢复至平衡状态。传统的PID 算法在各类工业场合有3 a# |' Z+ p, S3 u& _- e2 f7 w
着广泛的应用， 完全可以满足本控制系统的要求， 因此本控制系统设计采用PID
" G' m6 Z# z( F控制算法。$ P' |9 P- U5 _* s7 Y4 I) U' `
3 系统原理分析1 Z" G8 S- R+ W# K
3.1 控制系统任务分解
1 k! K$ F- K5 b# A. _/ c根据系统要求，小车必须能够在没有外界干预的情况下依靠两个同轴安装的
6 v3 X: K" C& i' s0 b4 Z0 x: B, u. Q车轮保持平衡，并完成前进，后退，左右转等动作。相对于四轮车，控制系统的
. j% G8 W& a! P$ [2 G: j任务更为复杂， 为了能解决该问题， 首先将复杂的问题分解成简单的几个问题进$ W; |: x0 b/ q
行讨论。
! `1 M$ U0 P- E4 {7 w0 e4 F3 {对系统要求进行分析， 可知维持小车直立， 并在受到外界干扰后迅速恢复稳( u# b; `4 ?/ K4 o/ F
态，完全依赖于一对直流电机对车轮的驱动。因此本控制系统的设计可以从对电9 \! {$ m& y, ~
机的控制着手， 控制电机的转速以及转向来实现对小车的控制。小车的控制任务( N- u8 n) v5 [5 g/ t. _. V, q* b
可以分解成以下三个基本任务：7 g! p( L, r3 v1 e- }
（1） 控制小车直立：通过控制两个电机的转向保持小车的直立状态。1 w/ B4 [% t; u1 i9 J- W& j( ]
（2） 控制小车车速：通过控制两个电机的转速实现车速控制。
& t1 W i3 I( w. w8 h% n5 P' o3 l（3） 控制小车转向：通过控制两个电机的转速差实现转向控制。
) b! S. @+ ]* R1 z D5 D* n: @以上三个任务都是通过控制小车两个车轮的驱动电机完成的。' W. D2 p5 }2 k1 |
直流电机的控制最终取决于电机两端输入的电压大小， 将电机近似认为处于( J. R3 W9 J+ N6 \6 ~
线性状态， 因此上述三个基本任务可以等效成三种不同控制目标的电压， 将这三% u- u# I- D6 L* [; L# D% k6 l9 m% k
种电压进行叠加后， 便可以得到最终所需的电压， 并将其施加在电机上以达到所
1 T6 |( V4 u# M3 n& j; J追求的控制效果。3 u% q, ?3 ~8 a7 p5 Q" a
在这三个任务中， 保持小车平衡是关键， 三个任务执行的优先级为： 平衡控
o- f) a0 S; t6 o I' \43 M9 f9 b/ j- T6 N
制>速度控制>转向控制。由于小车同时受到三种控制的影响， 从平衡控制角度来1 U+ l3 z0 P) c: K7 Z9 t2 ?! `+ B, j
看，其他两个控制就成为了它的干扰。因此对小车速度、方向的控制应该尽量保
* R7 e; W( Y1 ~$ d7 x1 e; }, R持平滑，以减少对平衡控制的干扰。
3 B1 R* P! M% z5 U9 _. W/ t上述三种控制各自独立进行，它们各自假设其他两个控制都已经达到稳定。) w4 y, o0 \9 {8 s7 b* V2 M
比如控制小车加速和减速的时候， 平衡控制一直在起作用， 它会自动改变小车的% ]/ h i6 n0 e
倾角，使小车实现加速和减速。& z" O J9 e$ N x
) R; A( P8 } v! e5 V
毕业设计(论文)--基于单片机的两轮自平衡车控制系统设计.pdf
(475.57 KB, 下载次数: 6)
0 o: n! I, L# m+ a8 y( D
|
|
/1 
发表于 2019-11-20 14:30
收藏
淘帖
支持！
反对！