2014肖春元毕业论文两轮自平衡循迹小车答辩

《2014肖春元毕业论文两轮自平衡循迹小车答辩》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、毕业论文答辩双轮自平衡机器人移动控制系统设计2014.5.23研究背景及意义从社会发展来看现代社会自动化水平越来越来高，人们迫切需要更智能化的工具代替人工，提高效率。所以本设计顺应时代潮流。从环境保护来看当今世界环境污染、能源危机问题越来越来严重，而两轮车有节能、方便、无污染的优势，所以研究有良好的市场导向。研究背景及意义从学术研究来看双轮自平衡机器人是一个复杂的动态控制过程，具有多变量、非线性、强耦合等特点，对实践要求较高。作为一个自动化本科毕业生，研究它可以提高我的分析、设计能力，开阔我的眼界。所

2、以该设计值得为之努力。设计总体思路11.建立模型和理论分析（包括:直流电机对车模姿态的控制分析、判断系统的能控能观性、车模倒立摆模型分析）22.对机器人（小车）的任务分解，包括直立控制、速度控制、方向控制。3硬件选型及硬件电路设计设计总体思路4根据硬件特点，需要对硬件反馈数据（数据有误差）进行滤波处理。5根据模型和理论分析，小车需要反馈控制才能平衡运行，设计PID控制器反馈调节车模。6软件设计实现与综合调试建立直流电机空间状态方程小车直流电机模型如下图:建立直流电机空间状态方程由上图，结合电机动力学原

3、理，电路理论，现代控制理论可得状态间方程（具体论文有推导）：由以上状态空间方程，可知通过控制输入电压U就可以控制车模倾角和速度。判断系统的能控能观性代入参数的系统状态方程如下：同理用obsv（，），obsvf（，）就可得到系统为满秩的能观系统。车模倒立摆模型分析根据小车实际的受力情况可建立如下的“倒立摆”物理模型设小车重心集中在黑色圆里，在小车沿杆（刚体）方向，在杆的支撑力作用下可以平衡，由力学平行四边形分解法则，可得垂直杆方向运动方程：由小车角度很小，可得，可简化为：当小车静止时加速度为0.车模倒立

4、摆模型分析要想使系统稳定就要加入比例、微分反馈控制可得”倒立摆”模型传递函数：得“倒立摆”两个极点为：两极点有一个在右半平面，系统不稳定。车模倒立摆模型分析由梅森公式可得系统传递函数为：加入比例、微分反馈控制后的系统框图如下：车模倒立摆模型分析·●并由此在设计车模稳定控制时，设计一个由角度和角速度构成的软件比例、微分控制可使小车动态平衡。这是很重要的理论基础此时系统的两极点为：上式可知，当时，两根在左半平面，由奈奎斯特稳定判据得系统稳定。任务分解及总体设计构架设计任务是：小车直立行走并可以根据红外检测

5、地面灰度信号循迹平衡直立控制根据倾角控制电机正反转使小车在前倒时向前加速产生惯性力使小车平衡同时采用PI反馈控制是系统稳定不震动速度控制通过光电编码采集的速度信息并滤波，用PWM改变电机电压控制转速对速度采用速度反馈PD控制使偏差接近0方向控制就是根据红外反射的高低电平检测黑线偏离，控制电机差速比例控制就可改变方向任务分解及总体设计构架控制器采用STC12C5A60S2，下面就系统总控制框图选择合适硬件完成以上信息采集和控制目标系统总控制框图如下：硬件选型及硬件电路1.主控芯片STC12C5A60S2

6、(经济便宜）2.电源模块（12V学校借的开关电源，5V由LM2596S降压得到）3.电机驱动（L298N），电机就用减速比1：30的减速电机4.传感器模块（光电编码、陀螺仪和加速度计mpu6050、红外循迹传感器）硬件选型及硬件电路LM2596S电路原理图硬件选型及硬件电路L298N原理图硬件选型及硬件电路Mpu6050电路原理图传感器数据融合和滤波陀螺仪测量角速度信息，加速度计测量角加速度信息，得到倾角陀螺仪要角速度积分，加速度计要利用X、Z轴的角加速度反正切值1.分析集成芯片MPU6050（陀和加

7、）采集数据特点，得出为什么要滤波，滤波的重要性传感器数据融合和滤波由上微分方程，以accel-Q为加速度计估计陀螺仪的一个常值偏差可得系统的状态方程和测量方程：2.陀螺仪和加速度计的微分方程传感器数据融合和滤波系统状态方程和测量方程如下：传感器数据融合和滤波将状态方程和观测方程离散化得：传感器数据融合和滤波3.卡尔曼滤波五个重要方程x(k

8、k-1)=Ax(k-1

9、k-1)+BU(K)A=B=传感器数据融合和滤波卡尔曼滤波五个方程不断获取最优值过程可解释为;上一状态X(K-1

10、K-1)预测现态值X(K

11、

12、K-1)由P(K-1

13、K-1)更新P(K

14、K-1)协方差综合预测值和测量值得现在最优值更新Kalman增益与P（k

15、k-1）有关由Km.P(K

16、K-1)更新P(K

17、K)时的协方差这样可以不断循环获取最优且效率较高传感器数据融合和滤波互补滤波就是保留加速度计的静态角度,低通滤去快速变化的信号,高通滤去陀螺仪静态角速度信息.两组信息取不同权重系数(陀螺仪大)计算式如下:通过卡尔曼滤波和互补滤波可以使倾角更接近实际有利平衡控制,且两组滤波可以软件实现,互补滤波