伺服运动控制系统

1、伺服运动控制系统研究生课程论文课程论文成绩:评语:任课教师签字:年月日战车云台位置伺服控制器参数设计与系统仿真XXX,控制科学与工程学科，XXX摘要：对于给定信号，为了实现战车云台角度伺服的高精度和快速响应的功能，本文首先建立单轴云台系统的数学模型，详细地介绍速度环比例控制器和位置环比例-积分-微分控制器参数设计的过程，两个控制器采用串级形式，然后整个位置伺服系统在Matlab/Simulink上仿真，对于单位阶跃响应，系统超调量38%,上升时间0.7s,稳态误差控制在3%以内，再用幅值为1、频率不同的正弦信号作为输入对系统进行测试，发现在4.6Hz频率响应下滞后时间0.49s,在4.9Hz频

2、率响应下，闭环系统幅值衰减到0.707,确定闭环系统带宽4.9Hz,同时对系统动态性能和稳态性能进行分析，确定了设计的系统基本满足要求。关键词：角度伺服；比例-积分-微分控制器参数设计；Matlab/Simulink仿真；动态性能和稳态性能1引言首先，本文位置伺服控制系统的设计背景来自于全国大学生机器人比赛的RoboMaster战车对抗赛。战车云台为双轴伺服控制系统，其要求输出的角度位置完全复现输入的角度位置信号及其变化趋势，即实现快速响应和高精度跟踪的功能。为了简化系统设计，本文只选取俯仰（pitch）轴的自由度进行说明，偏航（yaw）轴同理。战车的云台上的弹仓要加满直径7mm的子弹，在场地

3、移动，对敌人跟踪与打击。战车车体的运动、云台中子弹的晃动以及惯性大的弹仓和支架对于控制系统的设计是很大的挑战，云台不但要克服惯性，还要抗干扰。选择大扭矩、高转速的RM6025永磁同步电机作为执行器，自带霍尔元件角位移传感器和电流闭环，作为角度信息的实时反馈。为了实现快速跟踪性能，选择MPU6050三轴角速度角加速度传感器测得云台俯仰轴角速度，实现速度反馈功能。伺服运动控制系统研究生课程论文2云台模型2.1 电机及负载模型忽略永磁同步电机的电磁惯性时间常数，电机的速度输出与电压的关系可以等效为一个简单的积分环节和惯性环节串联，其开环传递函数为KiWi(s)=(1)S(TmiS1)其中Ki为开环增

4、益，Tmi为电机机械惯性时间常数。表1为RM6025电机规格参数。表1RM6025电机规格参数额定电压12V额定电流0.3A额定功率3.6W空载转速450r/min堵转扭矩700mN/m堵转电流3A角度控制精度0.010重量600g忽略机械摩擦及干扰，电机和弹仓角速度输入和角度输出同样可等效为一个简单积分环节和惯性环节串联，其开环传递函数为K2,、W2(s)=(2)S(Tm2S1)其中K2为开环增益，Tm2为负载机械惯性时间常数。因此位置伺服系统控制对象的开环传递函数为Wr(s)=(3)K1K22S2(TmiS1)(Tm2S1)其中Ki=0.4,Tmi=0.12,K2=4.5,丘=0.24(4

5、)伺服运动控制系统研究生课程论文2.2 模型稳定性与裕度分析由传递函数（3）,位置伺服系统的控制对象开环对数幅频-相频曲线如图1,由幅频特性曲线可知，以-4斜率穿越0dB,系统不稳定，相频特性曲线全在-180,图1云台模型开环对数幅频、相频特性曲线以下，相角裕度为负值，系统不稳定，需要校正。一般情况下，为使系统有满意的性能，相位裕度应在3060之间，而增益裕度应大于6dB0要求相位裕度应在3060之间，在大多实际情况下，意味着开环对数幅频特性在穿越频率上的斜率为-20dB/ded1。3控制器设计和仿真结果分析为了满足位置伺服系统的快速响应和抗干扰要求，将系统设计成位置环、速度环双闭环位置伺服系

6、统，其动态结构框图如图2所示。角度角度-实际图2双闭环位置伺服控制系统动态结构图伺服运动控制系统研究生课程论文3.1 速度环控制器设计速度环控制对象开环形式如（1）式，是典型的I型系统，闭环为二阶梯系统，如果速度环控制器设置为P型控制器，速度环就可以得到良好的抗扰性能,符合调速系统的要求。速度环控制器的开环传递函数可以写成Wasr(s)=Kp(5)根据上阶最佳系统，1=0.707,KT=0.52,使得动态响应速度和超调量折中,就有KpKiTmi=0.5,所以Kp=10.42。即有速度环开环传递函数将（4）中的已知量带入（6）,速度环开环传递函数对数幅频、相频特性曲线如图3,可知幅频特性曲线以-

7、20dB/dec斜率穿越0dB线，相角裕度41,满足设计要求。图3速度环开环传递函数对数幅频、相频特性曲线3.2 位置环控制器设计速度环闭环传递函数为Ws(s)1,、Wcls(s)=_.(7)1Ws(s)工Ls2.，s1KpKiKpKi忽略高次项，WAis（s）可降阶近似为伺服运动控制系统研究生课程论文1-Wcls(s)=(8)s1KpKi则位置伺服系统可表示成图4动态结构角度期望值图4位置伺服控制系统动态结构图位置环控制对象的开环传递函数为K2一Wp(S)=Wcls(S)W2(S)=i(9)s(1s1)(Tm2S1)KpKi要将控制对象校正成R型系统，可采用PID控制器，故位置环控制器的开环

8、传递函数为Wapr(s)二(四叱(10).1令71=,使控制对象中的大惯性环节对消。校正后的系统开环传递函数即KpK1为典型II型系统的形式。K2(2S1)令.2h二Tm2若h越大，则系统的-20dB/dec中频段越宽，根据文献2,h值在310之间选择,则令h=5,即有72=5Tm2(12)根据公式(13)2K2_h12h2Tm22(13)可得伺服运动控制系统研究生课程论文(14)2K2h2Tm22T=h1将(4)(12)(14)带入(11),可得系统开环传递函数W(s),其开环幅频、相频特性曲线如图5所示图5位置环开环传递函数对数幅频、相频特性曲线可知幅频特性曲线以-20dB/dec斜率穿越

9、0dB线，相角裕度42,满足设计要求3.3仿真和结果分析用Matlab/Simulink搭建云台仿真框图，如图6所示，分别用单位阶跃信号和不同频率正弦信号作为输入，对仿真系统进行测试。图6云台仿真框图云台系统闭环传递函数单位阶跃响应如图7,满足n型系统超调大，抗干扰效果好的特征，系统超调量38%,上升时间0.7s,稳态误差可以控制在3%以内。仿真的系统为线性系统，控制器在阶跃信号的输入下，导致控制器饱和，出现了非线性环节，使得超调量过大。还有在设计位置控制器时，将速度闭环传递函数的二次项忽略了，这也是超调过大的原因。伺服运动控制系统研究生课程论文图7云台系统单位阶跃响应用幅度为1,频率分别位4

10、.6Hz、4.7Hz、4.8Hz和4.9Hz的正弦信号作为输入信号，并分别记录其实时响应，分别如图8（a）、（b）、（c）、（d）所示。伺服运动控制系统研究生课程论文图8横坐标为6s内采样数据个数，实际采集74个数据，纵坐标为实时响应的幅值（a）4.6Hz正弦输入信号和实际响应（b）4.7Hz正弦输入信号和实际响应（c）4.8Hz正弦输入信号和实际响应（d）4.9Hz正弦输入信号和实际响应由图8可以看出，云台系统在4.6Hz、4.7Hz、4.8Hz和4.9Hz的正弦信号输入下，实际响应的幅值从1衰减到0.707,初步认定系统的带宽在4.9Hz左右。有（4）知，云台系统的最大时间常数Tm2=0.24,仿真结果基本符合实际情况，所以系统带宽4.9Hz。从图8（a）看出，在4.6Hz的正弦输入信号下，实时响应信号滞后了6个数据，时间为0.49秒，即滞后时间t.0.49s。4总结本文首先建立云台的数学模型，然后设计控制器，采用位置环和速度环用级的形式对其进行控制，仿真结果表明系统的单位阶跃响应超调量偏大，达到38%,不过基本无震荡，动态响应速度快，上升时间0.7s,稳态误差3%以内，精度较高。系