《2013简易旋转倒立摆详解》由会员分享,可在线阅读,更多相关《2013简易旋转倒立摆详解(16页珍藏版)》请在金锄头文库上搜索。
1、1一方案论证与比较一方案论证与比较1.1.1.1.主控方案的选择主控方案的选择1.1.11.1.1 方案一方案一 STC89C52STC89C52 单片机单片机STC89C52 是一种带 8K 字节闪烁可编程可擦除只读存储器的低电压,高性能 COMOS8 的微处理器,该器件采用 STC 高密度非易失存储器制造技术制造,与工业标准的 MCS-51 指令集和输出管脚相兼容。满足题目要求。图一 STC 控制方案1.2.角度传感器的选择1.2.1方案一:ADXL345角度传感器ADXL345 采用 14 引脚塑料封装,具有 3mm x 5mm x 1mm 的小巧纤薄的外形尺寸。具有高分辨率(3.9 m
2、g/LSB) ,能够测量约 0.25的倾角变化。使用 ADXL345 等数字输出加速度计时,可以无需进行模数转换,从而可以节省系统成本和电路板面积。2图二 ADXL345角度传感器1.3.倾斜角检测方案比较方案二:双轴倾斜计算与单轴解决方案一样,x 轴检测到的加速度与倾斜角的正弦具有比例关系,同时,与 x 轴垂直的 y 轴加速度与倾斜角的余弦成比例。随着某个轴的增量灵敏度的降低,另一轴的灵敏度则会增加。采用第二轴的另一个优势是能够对各个向量进行分区,并能够在整个 360 度内测量角度。故本设计采用此方案。 1.4.倒立摆系统控制算法的选择方案一:PID 控制通过对倒立摆系统物理模型进行力学分析
3、,建立其动力学模型,设计出 PID 控制器实现稳定控制。PID 参数的选择通常采用尝试法进行,但 PID 方案比较 成熟,可以使用。 二理论分析与计算 2.1 双轴倾斜计算 (1)恒定灵敏度x 轴检测到的加速度与倾斜角的正弦具有比例关系,同时,与 x 轴垂直的 y 轴加速度与倾斜角的余弦成比例(如图 1 所示) 。随着某个轴的增量灵敏度的降低,另一轴的灵敏度则会增加。3图 3 双轴倾斜检测中的输出加速度与倾斜角将测得加速度转换为倾斜角的一种方法是计算 x 轴的反正弦与 y 轴的反余弦。然而,一种更简单、更有效的方法是使用来自以下等式的两个值之比:)(tantansinlgsinlg,1,AAA
4、AOUTYOUTXOUTYOUTX)()()(其中倾斜角 单位为弧度。不同于单轴,利用两个轴之比来确定倾斜角的方法极大地增加了确定增量灵敏度的难度。由于一个轴的增量灵敏度会随着另一轴的减少而增加,因此两者的最终结果是一种几乎恒定的有效增量灵敏度。(2)对重心面对齐度的依赖行降低使用双轴或多轴的一个重要优势在于,在单轴解决方案下,除 x 轴以外的任何轴发生倾斜都会造成重大误差,与此不同,在使用第二轴时,即使第三轴存在倾斜时也可测得精确的值。这是因为有效增量灵敏度与目标轴重力的和方根(RSS)值具有比例关系。当重力完全处于 x y 平面之内时,这些轴上检测到的加速度和方根的理想值等于 1g。 如果
5、 x z 平面或 y z 平面中存在倾斜,则重力导致的总加速度会减少,同时会减少有效增量灵敏度。这又会加大既定加速度计分辨率下的倾斜步长,但仍可提供精确的测量值。经倾斜计算得到的角度对应于 x y 平面的旋转。(3)全角度 360 度倾斜检测采用第二个轴的另一个主要优势是能够对各个象限进行分区,并能在整个 360度内测量角度。如图 2 所示,每个象限均拥有与 x 轴和 y 轴加速度相关联的不同符号组合。4图 4 象限检测的倾斜角与加速度符号若操作数为正,则反正切函数在象限中返回一值;如果该操AAOUTYOUTX,/作数为负,则反正切函数在象限中返回一值。由于象限中的操作数为负,当角度处于该象限
6、时,必须在计算结果中加上 180 度的值。由于象限中的操作数为正,当角度处于该象限时,必须从计算结果中减去 180 度的值。计算所得角度的正确象限可通过考察各轴上测得加速度的符号来确定。(4)反馈调节反馈网络调节电机转速+输入信号比较输出信号图 5 反馈调节框图A:传感器角度值;T:设定值;A-T:传感器角度值与设定值的差值传感器角度值变化:根据反馈调节理论,控制 A-T=0,输入为 A-T,输出为T=A。在这个调节过程中,由于惯性作用,A 会有一个波动,如图 4 所示:50.51.01.52.02.53.0t分1020304050A度达到平衡过程图 6 角度波动图2.22.2 电动机的选型电
7、动机的选型2.2.12.2.1 刚体受力分析刚体受力分析刚体绕定轴转动微分方程 第 k 个质元 切线方向 在上式两边同乘以 rk 对所有质元求和 刚体绕定轴转动微分方程(刚体的转动定律) 2.2.2 机械结构的综合考虑 考虑到旋转臂要与电机的转轴合理连接,而碳纤维是一种力学性能优异的新材 料,它的比重不到钢的 1/4,碳纤维树脂复合材料抗拉强度一般都在 3500Mpa 以上, 是钢的 79 倍,抗拉弹性模量为 230430Gpa 亦高于钢。因此选择碳纤维杆作为旋 转臂。 考虑到摆杆的重心要在一定范围内可调,以选择最佳的力矩与电机配合。因此, 我们制作重心可调控制杆作为摆杆。 考虑到摆杆绕轴转动
8、,轴选用直径 4MM 的轴承作为转轴。摩擦力小,光滑。T=50kkkkamfFkkkkamfFkkkkkkkramrfrF )(2 kkkkkkrmrfrF JM 62.2.32.2.3 电动机选择电动机选择 齿轮减速电机,是在普通直流电机的基础上,加上配套齿轮减速箱。齿轮减速 箱的作用是,提供较低的转速,较大的力矩。同时,齿轮箱不同的减速比可以提供 不同的转速和力矩。这大大提高了,直流电机在自动化行业中的使用率。本文选择 ZGA25 齿轮减速电机。作为动力装置。 齿轮减速电机是指齿轮减速箱和电机(马达)的组成体。这种组成体通常也可 称为齿轮箱电机或减速电机,通常由专业的减速机生产厂进行集成组
9、装好后成套供 货。齿轮减速马达的应用非常广泛,属于机械设备不可或缺的动力设备。2.32.3 驱动与控制算法驱动与控制算法2.3.12.3.1 PIDPID 控制算法控制算法在模拟控制系统中,控制器最常用的控制规律是 PID 控制。PID 控制器又称 PID 调节器,是工业控制中系统中常用的有源校正装置。可以用软件实现 PID 控制 算法,而且可以利用计算机的逻辑功能,使 PID 控制更加灵活。数字 PID 控制生产 过程是一种最普遍采用的控制方法。如下图所示。比例积分微分x被控对象x图 7 PID 原理系统的传感器得到的测量结果 控制器作出决定 通过一个输出设备来作出反应 控制器从传感器得到测
10、量结果,然后用需求结果减去测量结果来得到误差。然后用 误差来计算出一个对系统的纠正值来作为输入结果,这样系统就可以从它的输出结 果中消除误差。 最为理想的控制当属比例-积分-微分控制规律。它集三者之长:既有比例作用 的及时迅速,又有积分作用的消除余差能力,还有微分作用的超前控制功能。 当偏差阶跃出现时,微分立即大幅度动作,抑制偏差的这种跃变;比例也同时 起消除偏差的作用,使偏差幅度减小,由于比例作用是持久和起主要作用的控制规7律,因此可使系统比较稳定;而积分作用慢慢把余差克服掉。只要三个作用的控制 参数选择得当,便可充分发挥三种控制规律的优点,得到较为理想的控制效果。 本方案采用单回路 PID
11、 控制方案,选取摆杆角度作为反馈信号,此方案间接对 摆杆进行控制,系统结构框图如下图所示。PID控制器x旋转倒立摆+图 8PID 控制算法规定这个流程是用来为直流电机调速的;1.输入量 rin(t)为电机转速预定值;2.输出量 rout(t)为电机转速实际值;3.执行器为直流电机;4.传感器为光电码盘,假设码盘为 10 线;5.直流电机采用 PWM 调速 转速用单位 转/min 表示;6.偏差量为预定值和实际值之差(转/min);每个电压对应一个转速,电压和转速之间呈现线性关系。但是我考虑这种方法 的前提是把直流电机的特性理解为线性了,而实际情况下,直流电机的特性绝对不 是线性的,所以在正式进
12、行调速设计之前,需要现有开环系统,测试电机和转速之 间的特性曲线(或者查阅电机的资料说明),然后再进行闭环参数整定。假设采样间隔为 T,则在第 K T 时刻:偏差 err(K)=rin(K)-rout(K);积分环节用加和的形式表示,即 err(K)+err(K+1)+;微分环节用斜率的形式表示,即err(K)-err(K-1)/T;8从而形成如下 PID 离散表示形式:2.2.2PID2.2.2PID 子程序流程图子程序流程图计算偏差PID子程序开始计算比例项计算积分项并限幅计算微分项并限幅计算控制输出量PID子程序结束调用电机控制子程序93硬件电路硬件电路设计设计本系统主要由主控制器模块,
13、角度检测模块,机械结构模块等组成,系统连接图如图所示:单片机电机角度传感器信号控控制制转转 动动机械连接采集传输通信图 9 系统模块组成3.13.1 硬件电路设计硬件电路设计硬件电路部分主要由单片机控制模块、电机驱动模块、角度传感器检测模块、 电源模块等部分组成,系统原理图如下图所示:3.1.13.1.1 单片机最小系统电路图单片机最小系统电路图图10单片机最小系统图103.1.23.1.2 L298NL298N 电机驱动模块电路图电机驱动模块电路图图11电机驱动图3.1.33.1.3 角度传感器角度传感器图12角度传感器11角度传感器测得 X、Y 轴方向的重力加速度,通过 IIC 通信将信号
14、输入单片机,单片机合成数据,得到 X、Y 轴方向加速度的值,从而计算得出角度值,然后利用屏幕将角度值实时显示出来。3.23.2 程序结构与设计程序结构与设计开始电机转动检测是否达到最高点角度传感器摆杆倒立检测摆杆状态保持倒立旋转臂圆周运动YNY发挥 部分12程序结构如上图所示,本系统可完成摆杆从处于自然下垂状态(摆角 0)开 始,驱动电机带动旋转臂作往复旋转使摆杆摆动,并尽快使摆角达到或超过-60 +60直至完成圆周运动。四测试方案与测试结果四测试方案与测试结果测试方法:1.摆角的检测 测试工具:秒表,量角器 在摆杆后 12CM 处固定一个轻质量角器,以方便观察摆杆的旋转角度。测试摆 角达到正
15、负 60 度的时间。 次数123456789 时间 (秒)446544546表一:摆角的检测记录测试结果分析:理想情况下,摆杆达到正负 60 度的时间很短,但由于电机转 轴和和旋转臂的连接处有摩擦,电机加速控制需要时间,所以,实际测量与理论有 差距。 测试方法:2 开始到完成第一个圆周运动的时间 测试工具:秒表次数123456789 时间 (秒)767578756表二:完成圆周运动的时间记录测试结果分析:当摆杆达到 60 度的时候,增大电机转速可使摆杆完成圆周运 动。因此,从开始状态到完成圆周运动所需的时间很短。本装置完成此项要求的时 间比较理想。 测试方法 3:外力拉起至 165 度位置,外
16、力撤出的同时,启动控制旋转臂使摆 杆保持倒立的时间 测试工具:秒表 次数123456789 时间 (秒)434554565表三:保持倒立时间记录 测试结果分析:由于装置本身的不稳定性,使旋转臂转动时出现抖动,影响倒 立时间的维持。此因素的影响难以消除。13五总结五总结本旋转倒立摆能够实现题目的基本要求,并能完成发挥部分的部分功能。但装 置稳定性方面还需要进一步改善。六参考文献六参考文献1模拟电子电路及技术基础 ,孙肖子著,西安:西安电子科技大学出版社, 2008 年; 2自动控制原理 ,杨友良著,北京:电子工业出版社,2000 年; 3模拟电子线路基础 ,吴运昌著,广州:华南理工大学出版社,2004 年;4数字电子技术基础 ,阎石著,北京:高等教育出版社,1997 年; 5数据结构与算法 ,张晓丽等著,北京:机械工业出版社,2002 年; 6