哈工大自控元件课设一级倒立摆.docx
- 文档编号:12925386
- 上传时间:2023-04-22
- 格式:DOCX
- 页数:39
- 大小:918.04KB
哈工大自控元件课设一级倒立摆.docx
《哈工大自控元件课设一级倒立摆.docx》由会员分享,可在线阅读,更多相关《哈工大自控元件课设一级倒立摆.docx(39页珍藏版)》请在冰豆网上搜索。
哈工大自控元件课设一级倒立摆
HarbinInstituteofTechnology
课程设计说明书
课程名称:
自控元件课程设计
设计题目:
一级旋转倒立摆系统
院系:
控制科学与工程-自动化
班级:
设计者:
指导教师:
赵辉伊国兴
设计时间:
2015年5-6月
哈尔滨工业大学
一级旋转倒立摆系统
摘要:
对于倒立摆系统的研究长期以来被认为是控制理论及其应用领域里引起人们极大兴趣的问题。
倒立摆系统是一个典型的快速、多变量、非线性、不稳定系统。
研究倒立摆控制能有效地反应控制中的许多问题。
倒立摆研究具有重要的理论价值和应用价值。
理论上,它是检验各种新的控制理论和方法的有效实验装置。
应用上,倒立摆广泛应用于控制理论研究、航空航天控制、机器人、杂技顶杆表演等领域,在自动化领域中具有重要的价值。
本文主要介绍了我们小组研制的一级旋转式倒立摆系统,它是一个典型的机电一体化系统,采用内置STM-32运动控制器和直流电机进行实时运动控制。
关键词:
倒立摆;;STM32;增量码盘;直流有刷电机
一、引言
倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论教学及开展各种控制实验的理想实验平台。
许多抽象的控制概念如系统稳定性、可控性、系统收敛速度和系统抗干扰能力等,都可以通过倒立摆直观的表现出来。
倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。
最初研究开始于二十世纪50年代,麻省理工学院(MIT)的控制论专家根据火箭发射助推器原理设计出一级倒立摆实验设备。
近年来,新的控制方法不断出现,人们试图通过倒立摆这样一个典型的控制对象,检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力,从而从中找出最优秀的控制方法。
倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展。
由于控制理论的广泛应用,由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。
平面倒立摆可以比较真实的模拟火箭的飞行控制和步行机器人的稳定控制等方面的研究。
对倒立摆系统的研究能有效的反映控制中的许多典型问题:
如非线性问题、鲁棒性问题、镇定问题、随动问题以及跟踪问题等。
通过对倒立摆的控制,用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。
同时,其控制方法在军工、航天、机器人和一般工业过程领域中都有着广泛的用途,如机器人行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制等。
倒立摆系统具有模块性好和品种多样化的优点,其基本模块既可是一维直线运动平台或旋转运动平台,也可以是两维运动平台。
通过增加角度传感器和一节倒立摆杆,可构成直线单节倒立摆、旋转单节倒立摆或两维单节倒立摆;通过增加两节倒立摆杆和相应的传感器,则可构成两节直线倒立摆和两节旋转倒立摆。
倒立摆的控制技巧和杂技运动员倒立平衡表演技巧有异曲同工之处,极富趣味性,学习自动控制课程的学生通过使用它来验证所学的控制理论和算法,加深对所学课程的理解。
由于倒立摆系统机械结构简单、易于设计和制造,成本廉价,因此在欧美发达国家的高等院校,它已成为常见的控制教学设备。
虽然倒立摆的形式和结构各异,但所有的倒立摆都具有以下的特性:
1)非线性
倒立摆是一个典型的非线性复杂系统,实际中可以通过线性化得到系统的近似模型,线性化处理后再进行控制。
也可以利用非线性控制理论对其进行控制。
倒立摆的非线性控制正成为一个研究的热点。
2)不确定性
主要是模型误差以及机械传动间隙,各种阻力等,实际控制中一般通过减少各种误差来降低不确定性,如通过施加预紧力减少皮带或齿轮的传动误差,利用滚珠轴承减少摩擦阻力等不确定因素。
3)耦合性
倒立摆的各级摆杆之间,以及和运动模块之间都有很强的耦合关系,在倒立摆的控制中一般都在平衡点附近进行解耦计算,忽略一些次要的耦合量。
4)开环不稳定性
倒立摆的平衡状态只有两个,即在垂直向上的状态和垂直向下的状态,其中垂直向上为绝对不稳定的平衡点,垂直向下为稳定的平衡点。
5)约束限制
由于机构的限制,如运动模块行程限制,电机力矩限制等。
为了制造方便和降低成本,倒立摆的结构尺寸和电机功率都尽量要求最小,行程限制对倒立摆的摆起影响尤为突出,容易出现小车的撞边现象。
正是由于由于倒立摆系统的上述特性,许多现代控制理论的研究人员一直将它视为研究对象,并不断从中发掘出新的控制理论和控制方法。
因此,倒立摆系统也是进行控制理论研究的理想平台。
直线运动型倒立摆外形美观、紧凑、可靠性好。
除了为每个子系列提供模块化的实现方案外,其控制系统的软件平台采用开放式结构,使学生建立不同的模型,验证不同的控制算法,供不同层次的学生进行实验和研究。
由于采用了运动控制器和伺服电机进行实时运动控制,以及齿型带传动,固高公司的倒立摆系统还是一个典型的机电一体化教学实验平台,可以用来进行各种电机拖动、定位和速度跟踪控制实验,让学生理解和掌握机电一体化产品的部件特征和系统集成方法。
二、作品简介
我们小组研制的一级旋转式倒立摆系统,是一个典型的机电一体化系统,采用内置STM-32运动控制器和直流电机进行实时运动控制。
一级旋转式倒立摆,及其功能扩展后为典型的调节系统,应用了自动控制元件,自动控制原理,计算机控制,现代控制理论等多个控制课程所学内容,是第一次尝试从理论推导建模到实物制作、器件选材到计算机仿真的完整的控制系统设计过程。
倒立摆及其功能扩展的位置伺服系统作为一种自动控制教学实验设备,能够全面地满足自动控制教学的要求。
许多抽象的控制概念如系统稳定性、可控性、系统收敛速度和系统抗干扰能力等,都可以通过实验装置直观的表现出来。
由于倒立摆系统的高阶次、不稳定、多变量、非线性和强耦合等特性,许多控制理论的研究人员一直将它作为研究对象,并不断从中发掘出新的控制理论和控制方法,相关的成果在航天科技和机器人学方面获得了广泛的应用。
因此,倒立摆设备也是进行控制理论研究的理想平台。
一级旋转式倒立摆系统可以方便地构成一个位置控制系统的被控对象,并配置由增量式码盘组成的测量元件,构成位置控制系统进行经典控制理论(调节原理)的模型,在计算机上实现系统的稳定性、时域特性、频域特性分析和品质校正的实验。
此外,配置计算机控制系统和控制系统计算机辅助设计等课程的相关软件,用于控制系统设计类课程的实验。
综上所述,一级旋转式倒立摆系统对于控制系的学生来说是一个非常好的科创小作品。
产品使用STM-32芯片来控制直流调速电机,有利于系统的小型化,控制更加快速,抗干扰性强,控制品质有很大提高,利用增量式光电码盘来测量转角,使用PID调节进行整定,构成了完整且方便调试的闭环系统。
三、一级旋转式倒立摆设计概述:
1.1系统总体结构
见实物图
1.2机械结构
我们的一级倒立摆由以下几部分组成:
底盘:
木质,用于承载整个倒立摆。
竖直支架和水平支架:
采用硬质铝合金机械加工而成。
同时为了节省材料和减少加工难度,将理论建模中的圆盘改为直杆,二者在此模型中是等效的。
摆杆:
即倒立摆,硬质铝合金材料。
两个转动轴:
本倒立摆共有两个自由度的旋转轴,其中一个为水平支架在水平方向的旋转,为直流电机驱动。
另一个为摆杆在竖直方向上的旋转,无驱动,靠系统自稳来平衡.
1.3硬件部分
测量元件:
增量式光电码盘,型号:
欧姆龙编码器E6B2-CWZ6C
执行元件:
直流调速电机
主控板:
STM-32f103单片机
基本控制思路如下:
通过STM-32单片机调节PWM占空比,从而改变直流电机电流,而直流电机电流正比于电机输出力矩T,电机输出力矩T作用到水平支架上,通过相互作用力又作用到摆杆上力矩P,通过力矩P与角度关系换算成摆杆的摆动角度θ。
而以上一系列过程最后整定为一个系数K体现在模型中。
1.4模型建立
M——转盘质量
m——摆杆质量
l——摆杆轴心到质心的距离
I——摆杆惯量
T——加在转盘上的力矩
x——转盘转角
——摆杆与竖直向上方向的夹角
b——转盘半径
N、P为摆杆与转盘间在水平和竖直方向的相互作用力
转盘水平方向受力分析:
摆杆水平方向受力分析:
摆杆垂直方向受力分析:
力矩平衡方程:
设
<<1,则
,
,
对上式进行拉氏变换得:
上式即为最终推倒的被控对象的传递函数。
1.5模型仿真
整个系统控制框图:
将如下数据代入模型中:
M=1;
b=0.5;
m=0.1;
I=2;
l=0.2;
g=9.8;
最终计算的出被控对象即摆杆的传递函数近似为
,此传递函数输入为电机输出的力矩T,输出为摆杆的角度θ。
我们发现此传递函数有一个不稳定极点,但经过PID校正后并不影响系统最终收敛稳定。
我们使用MATLAB2009A版本的SIMULINK模块对此进行计算机仿真。
仿真过程如下:
未加任何校正的仿真图
从图中可以看到未加任何校正时,在脉冲干扰下,系统将持续震荡。
加PID校正但未进行参数整定:
系统依然震荡,即摆杆仍在震动,未成功倒立。
进行比例调节,将Kp调至200:
可以看到调整效果很明显,等幅震荡变为减幅震荡,最终归于稳定,即摆杆可以可以实现自倒立。
再次进行PID参数调节进一步优化性能,将Ki增大为5,。
可以看到改进效果并不是很明显。
最后进行Kd的参数调节,将Kd增至50,。
发现调整时间并不是很好,再将Kd适当调小,调为20.
此时调整时间几乎和脉冲峰值同时收敛,在外力干扰下,摆杆自稳速度快而且自稳性能好,几乎无震荡。
所以理论上,最终PID参数整定为Kp=200,Ki=5,Kd=20。
另外,其实Ki的作用并不大,将Ki环节去掉
会发现其实效果几乎差不多,即对于此倒立摆系统,PD调节和PID调节效果差不多。
但鉴于PID调节的通用性,我们在实际给STM-32单片机编程时,程序中依然采用PID调节进行整定。
四、各元件选型及选择理由
主控板选型
STM-32f103
该系列单片机优点如下:
STM32F1系列属于中低端的32位ARM微控制器,该系列芯片是意法半导体(ST)公司出品,其内核是Cortex-M3。
该系列芯片按片内Flash的大小可分为三大类:
小容量(16K和32K)、中容量(64K和128K)、大容量(256K、384K和512K)。
芯片集成定时器,CAN,ADC,SPI,I2C,USB,UART,等多种功能。
内核:
--ARM32位的Cortex-M3
--最高72MHz工作频率,在存储器的0等待周期访问时可达1.25DMips/MHZ(DhrystONe2.1)
--单周期乘法和硬件除法
存储器:
--从32K到512K字节的闪存程序存储器(STM32F103XXXX中的第二个X表示FLASH容量,其中:
“4”=16K,“6”=32K,“8”=64K,B=128K,C=256K,D=384K,E=512K)
--最大64K字节的SRAM
电源管理:
--2.0-3.6V供电和I/O引脚
--上电/断电复位(POR/PDR)、可编程电压监测器(PVD)
--4-16MHZ晶振振荡器
--内嵌经出厂调教的8MHz的RC振荡器
--内嵌带校准的40KHz的RC振荡器
--产生CPU时钟的PLL
--带校准的32KHz的RC振荡器
低功耗:
--睡眠、停机和待机模式
--Vbat为RTC和后备寄存器供电
模数转换器:
--2个12位模数转换器,1us转换时间(多达16个输入通道)
--转换范围:
0至3.6V
--双采样和保持功能
--温度传感器
DMA:
--2个DMA控制器,共12个DMA通道:
DMA1有7个通道,DMA2有5个通道
--支持的外设:
定时器、ADC、SPI、USB、IIC和UART
--多达112个快速I/O端口(仅Z系列有超过100个引脚)
--26/37/51/80/112个I/O口,所有I/O口一块映像到16个外部中断;几乎所有的端口均可容忍5V信号
调试模式:
--串行单线调试(SWD)和JTAG接口
--多达8个定时器
--3个16位定时器,每个定时器有多达4个用于输入捕获/输出比较/PWM或脉冲计数的通道和增量编码器输入:
--1个16位带死区控制和紧急刹车,用于电机控制的PWM高级控制定时器
--2个看门狗定时器(独立的和窗口型的)
--系统时间定时器:
24位自减型计数器
--多达9个通信接口:
2个I2C接口(支持SMBus/PMBus)
3个USART接口(支持ISO7816接口,LIN,IrDA接口和调制解调控制)
2个SPI接口(18M位/秒)
CAN接口(2.0B主动)
USB2.0全速接口
计算单元:
CRC计算单元,96位的新批唯一代码
封装:
ECOPACK封装
应用:
STM32F103R8T6是ST旗下的一款常用的增强型系列微控制器,适用于:
电力电子系统方面的应用
电机驱动;应用控制;医疗;手持设备;PC游戏外设;GPS平台;编程控制器(PLC);变频器;扫描仪;打印机;警报系统;视频对讲;暖气;通风空调系统等。
电机选型
直流有刷电机SK3530
该电机具体参数如下:
测量元件选型
E6B2-CWZ6C500P/R欧姆龙旋转编码器
该测量元件具体参数:
额定值/性能
项目型号
E6B2-CWZ6C
E6B2-CWZ5B
E6B2-CWZ3E
E6B2-CWZ1X
E6B2-CWZ5G
电源电压
DC5V—5%~24V+15% 脉冲(p-p)5%以下
DC12V—10%~24V+15% 脉冲(p-p)5%以下
DC5V—5%~12V+10% 脉冲(p-p)5%以下
DC5V±5% 脉冲(p-p)5%以下
DC12V—10%~24V+15% 脉冲(p-p)5%以下
消耗电流 *1
70mA以下
80mA以下
130mA以下
80mA以下
分辨率(脉冲/旋转)
10、20、30、40、50、60、 100、200、300、360、 400、500、600、1,000、 1,024、1,200、1,500、 1,800、2,000、2048、3000、3600
10、20、30、40、50、60、 100、200、300、360、 400、500、600、1,000、 1,024、1,200、1,500、 1,800、2,000、2048、3000、3600
10、20、30、40、50、60、 100、200、300、360、 400、500、600、1,000、 1,024、1,200、1,500、 1,800、2,000、2048、3000、3600
10、20、30、40、50、60、 100、200、300、360、 400、500、600、1,000、 1,024、1,200、1,500、 1,800、2,000、2048、3000、3600
10、20、30、40、50、60、 100、200、300、360、 400、500、600、1,000、 1,024、1,200、1,500、 1,800、2,000、2048、3000、3600 (特殊脉冲和型号可订做)
外径/轴
Ф40/Ф6
输出位相差
A相、B相的位相差90±45℃(1/4±1/8T)
输出上升 下降时间
1μs以下 控制输出电压:
5V 负载电阻1kΩ 导线长:
2m
1μs以下 (导线长:
2m 同步电流:
10mA)
0.1μs以下 导线长:
2m IO= -20mA、IS=20mA
起动转矩
10mN·m以下
惯性力矩
1×10-6kg·m2以下(600脉冲/旋转以下:
3×10-7kg·m2以下)
轴允许力
30N
20N
允许最高旋转数
6,000r/min
保护回路
负载短路保护、电源逆接线保护
——
环境温度范围
动作时:
-10~+70℃、保存时:
-25~+85℃(不结冰)
环境湿度范围
动作时、保存时:
各35~85%RH(不结露)
绝缘电阻
20MΩ以上(DC500V兆欧表) 充电部整体与外壳间
耐电压
AC500V 50/60Hz 1min 充电部整体与外壳间
振动(耐久)
10~500Hz 复振幅2mm或150m/s2 X、Y、Z各方向 1扫描 11min 3扫描
冲击(耐久)
1,000m/s2 X、Y、Z各方向 3次
保护构造
IEC规格 IP50
连接方式
IEC规格 IP64 (JEM规格 IP64f 防滴·防油)* 4
材质
ABS
铝
SUS420J2
质量(包装状态)
约100g
附件
使用说明书
注:
*1. 屏蔽线的外芯(屏蔽)不能与内部以及外壳连接。
*2.A相、B相、Z相都为同一回路。
*3. 通常GND要接到OV,或者接地上。
产品规格仅供参考,详细信息请于业务员联系。
五、成本预算
主控板:
60元
电机:
40元
码盘:
100元
材料:
硬质铝合金及加工在本校机电学院竞技机器人队实验室完成,估算成本为30元左右。
合计:
230元
六、设计小结
倒立摆是一个相对简单的模型,它在器件选择,理论建模等方面涉及的知识很全面而且相对简单,操作起来比较容易,因此我们选择它作为我们的课题。
但是在实际操作过程中还是遇到了很多问题。
比如在理论建模过程中,我们运用了基本的物理学知识如牛顿运动定律来推导倒立摆的运动学方程和动力学方程,但是在继续推导被控对象的传递函数时我们发现困难很多,因为以前学习时都是直接给出的传递函数。
最终我们通过一系列近似处理,推导出了最终的传递函数,并且经过一番向学长的虚心请教,使用MATLAB最终仿真出了理想的结果。
然而这只是理论推导,在电机选型,测量元件选型,电机驱动等方面,每一个方面我们都遇到了问题,只好向善于动手的电气学院的同学请教,最终终于搭建起了一个完整的倒立摆。
虽然过程比较曲折,不过最终做出了完整的倒立摆系统,也很有成就感,毕竟是我们第一次从无到有设计并搭建控制系统,我们很珍惜这个宝贵的第一次的经验和教训。
七、应用前景
由于倒立摆的深远的研究意义,从20世纪50年代倒立摆的最初研究至今,倒立摆的控制方法已经广泛应用在军工、航天、机器人控制领域和一般工业过程中。
现在,已经有无数课题正在应用或需要进一步的研究并应用倒立摆的实时控制方法才能解决其控制领域的相关问题,如:
(1)通信卫星在预先计算好的轨道和确定的位置上运行的同时,要保持其稳定的姿态,使卫星天线一直指向地球,使它的太阳能电池板一直指向太阳。
(2)侦察卫星摄像机的轻微抖动会对摄像的图像质量产生很大的影响,为了提高摄像的质量,必须能自动的保持伺服云台的稳定,消除振动。
(3)在火箭等飞行器的飞行过程中,为了保持其正确的姿势,要不断进行实时控制。
尤其是多级火箭由于近似多级倒立摆系统,所以飞行姿态的控制研究也可以很好借鉴多级倒立摆系统的控制方法,并在此之上进行研究。
(4)机器人的站立与行走也非常类似于双倒立摆系统。
尽管机器人问世至今已有三十多年的历史,但机器人的关键技术——机器人的直立行走控制至今仍未能很好解决,仍需进一步研究。
近年来,倒立摆系统不仅在高科技领域中得到广泛应用,人们还应用了倒立摆这样一个严格的控制对象,检验新的控制方法的正确性、可行性以及是否有较强的处理多变量、非线性、强耦合和绝对不稳定系统的能力。
八、参考资料
[1]孟巧荣,廉自生.倒立摆控制系统的控制与仿真[J],机械工程与自动化,2004:
2,7-9.
[2]齐峰,万少松.对倒立摆控制系统设计的仿真与比较[J],空军大学学报,2007,8
(2):
30-32.
[3]程俊,王永,黄南晨,等.旋转式倒立摆计算机控制系统[J],电机与控制学报,2001,5(4):
277-280.
[4]孙颖娥.旋转式倒立摆系统的设计与算法研究[D],合肥:
中国科学技术大学.2004.
[5]徐国锋,刘春生.非线性倒立摆起摆和稳定控制研究[J],计算机仿真,2002,3(11):
331-335.
[6]丛爽,张冬军,魏衡华.单级倒立摆三种控制策略对比研究[J],系统工程与电子技术,2001,23(11):
47-49.
[7]王良顺,尹平林.基于倒立摆的一种控制器的设计与仿真[J],计算机技术与自动化,2006,25
(1):
30-31.
[8]瞿亮,基于MATLAB的控制系统计算机仿真[M],清华大学出版社,2006年.
[9]薛定宇.控制系统计算机辅助设计——MATLAB语言及应用[M],北京:
清华大学出版社,1997年.
[10]徐春梅,杨平等.PID控制在倒立摆实时控制系统中的应用[J],微计算机信息,2006,22(7-1):
83-85.
九、(附)单片机PWM控制部分程序
程序:
#include"timer.h"
//通用定时器中断初始化
//这里时钟选择为APB1的2倍,而APB1为36M
//arr:
自动重装值。
//psc:
时钟预分频数
//这里使用的是定时器3
voidTimerx_Init(u16arr,u16psc)
{
RCC->APB1ENR|=1<<1;//TIM3时钟使能
TIM3->ARR=arr;//设定计数器自动重装值//刚好1ms
TIM3->PSC=psc;//预分频器7200,得到10Khz的计数时钟
//这两个东东要同时设置才可以使用中断
TIM3->DIER|=1<<0;//允许更新中断
TIM3->DIER|=1<<6;//允许触发中断
TIM3->CR1|=0x01;//使能定时器3
MY_NVIC_Init(1,3,TIM3_IRQChannel,2);//抢占1,子优先级3,组2
}
voidPWM1_1_Init(u16arr1,u16psc1)
{
//此部分需手动修改IO口设置
RCC->APB1ENR|=1<<1;//TIM3时钟使能
GPIOA->CRL&=0XF0FFFFFF;//PA6输出
GPIOA->CRL|=0X0B000000;//复用功能输出
GPIOA->ODR|=1<<6;//PA6上拉
TIM3->ARR=arr1;//设定计数器自动重装值
TIM3->PSC=psc1;//预分频器不分频
TIM3->CCMR1|=7
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 哈工大 自控 元件 一级 倒立