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

I基于单片机的两轮自平衡车控制系统设计摘要两轮自平衡车是一种高度不稳定的两轮机器人，就像传统的倒立摆一样，本质不稳定是两轮小车的特性，必须施加有效的控制手段才能使其稳定。本文提出了一种两轮自平衡小车的设计方案，采用重力加速度陀螺仪传感器MPU-6050检测小车姿态，使用互补滤波完成陀螺仪数据与加速度计数据的数据融合。系统选用STC公司的8位单片机STC12C5A60S2为主控制器，根据从传感器中获取的数据，经过PID算法处理后，输出控制信号至电机驱动芯片TB6612FNG，以控制小车的两个电机，来使小车保持平衡状态。整个系统制作完成后，小车可以在无人干预的条件下实现自主平衡，并且在引入适量干扰的情况下小车能够自主调整并迅速恢复至稳定状态。通过蓝牙，还可以控制小车前进，后退，左右转。关键词：两轮自平衡小车加速度计陀螺仪数据融合滤波PID算法IIDesignofControlSystemofTwo-WheelSelf-BalanceVehiclebasedonMicrocontrollerAbstractTwo-wheelself-balancevehicleisakindofhighlyunstabletwo-wheelrobot.Thecharacteristicoftwo-wheelvehicleisthenatureoftheinstabilityastraditionalinvertedpendulum,andeffectivecontrolmustbeexertedifweneedtomakeitstable.Thispaperpresentsadesignschemeoftwo-wheelself-balancevehicle.WeneedusinggravityaccelerometergyroscopesensorMPU6050fortheinclinationangleofvehicle,andusingcomplementaryfilterforthedatafusionofgyroscopeandaccelerometer.Wechoosean8-bitmicrocontrollernamedSTC12C5A60S2fromSTCCompanyasmaincontrollerofthecontrolsystem.Themaincontrolleroutputcontrolsignal,whichisbasedonthedatafromthesensors,tothemotordrivechipnamedTB6612FNGforcontrollingtwomotorsofvehicle,andkeepingthevehicleinbalance.Afterthecompletionofthecontrolsystem,thevehiclecanachieveautonomousbalanceundertheconditionsofunmannedintervention,thevehiclecanadjustautomaticallyandrestoredtoastablestatequicklyinthecaseofgivingappropriateinterferenceaswell.Inaddition,wecancontrolthevehicleforward,backwardandturnaround.Keywords:Two-WheelSelf-BalanceVehicle;Accelerometer;Gyroscope;Datafusion;Complementaryfilter;PIDalgorithmIII1绪论.......................................................................................................................................11.1自平衡小车的研究背景................................................................................................11.2自平衡小车研究意义....................................................................................................11.3论文的主要内容............................................................................................................22课题任务与关键技术...........................................................................................................22.1主要任务........................................................................................................................22.2关键技术.........................................................................................................................22.2.1系统设计.................................................................................................................22.2.2数学建模.................................................................................................................22.2.3姿态检测..................................................................................................................32.2.4控制算法.................................................................................................................33系统原理分析.......................................................................................................................33.1控制系统任务分解........................................................................................................33.2控制原理........................................................................................................................43.3数学模型........................................................................................................................54系统硬件设计.......................................................................................................................64.1STC12C5A60S2单片机介绍............................................................................................74.2电源管理模块................................................................................................................84.3车身姿态感应模块........................................................................................................94.3.1加速度计...............................................................................................................104.3.2陀螺仪...................................................................................................................124.4电机驱动模块..............................................................................................................144.5速度检测模块..............................................................................................................165系统软件设计.....................................................................................................................165.1软件系统总体结构......................................................................................................175.2单片机的硬件资源配置..............................................................................................185.2.1定时/计数器设置..................................................................................................185.2.2PWM输出设置......................................................................................................205.2.3串行通信设置..............................................