运动控制案例分析讲解.docx

ACRASR + 图1 整体流程框图运动控制案例分析大作业 所在学院： 自动化学院 学生姓名： 袁博楠 所在班级： 2011211402 学生学号: 2011211729 指导教师： 叶平 2014 年 5 月 25 日一、作业内容： 工业机器人关节运动控制系统设计与仿真工业机器人关节是由直流伺服电机驱动，采用双闭环可逆直流脉宽调速系统控制伺服电机来达到对工业机器人关节进行运动控制的目的，从而控制工业机器人的运动工业机器人关节的相关参数如下：（1）直流伺服电机参数：PN = 150W, UN = 48V, IN = 4A, nN = 400rpm，反电势系数：Ce = 0.12V/rpm，允许过载倍数λ = 2（2）系统主电路总电阻：R = 4Ω（3）电磁时间常数：T1= 0.012s（4）机电时间常数：Tm = 0.2s（5）PWM整流装置：放大系数Ks = 20, 失控时间Ts= 0.15ms（6）电流反馈系数1.25V/A，转速反馈系数0.025V/rpm（7）电流反馈滤波时间常数：Toi = 0.001s，转速率波时间常数：Ton = 0.014s（8）额定转速时的给定电压：Unm =10V（9）调节器饱和输出电压：10V（10）工业机器人关节减速比：10工业机器人关节运动控制系统的技术指标：（1）该调速系统能进行平滑的速度调节，具有较宽的调速范围（40rpm ~ 2rpm），系统在工作范围内能稳定工作；（2）系统静特性良好，无静差；（3）动态性能指标：转速超调量小于10%，电流超调量小于5%，动态速降小于85%，调速系统的过渡过程时间（调节时间）小于0.1s。

设计要求：（1）分析工业机器人关节闭环调速系统的组成，并画出系统框图；（2）依据系统的动静态指标要求，计算调速系统的参数确定转速调节器与电流调节器的结构型式及进行参数计算，使调速系统工作稳定，并满足动态性能指标的要求；（3）利用Matlab对所设计的双闭环调速系统进行仿真实验；（4）整理设计数据资料，撰写相关报告报告要有简洁的封皮，报告内容：概述、设计任务与要求、系统设计、Matlab建模及仿真和结论等；（5）利用（3）建立的仿真模型，探讨工业机器人各个关节所受不同转动惯量对运动控制系统设计的影响，并进行仿真实验；（选做）二、问题解决： 可以看出，此次作业旨在帮助大家应用和理解直流双闭环调速系统的相关知识，在应用中学习，并且用Matlab和simulink库对整个系统进行仿真，为我们对知识的掌握提供了大大地帮助1）分析工业机器人关节闭环调速系统的组成，并画出系统框图 在工业机器人关节处的调速系统应该使用双闭环调速系统，即转速调节和电流调节因为首先要保证转速受外界干扰和自身参数变化小，在不同的负载下的转速应力求一致，并且能够快速地消除干扰所造成的影响；电流调节也非常地必要，因为必须要保证电流不能超过所允许的最大值，例如在电机堵转的时候防止因负载无穷大而使电流过大，从而损坏电机。

根据上述的分析和书上所提供的相关资料，可以设计出直流双闭环调速系统的动态结构图如下图1所示：图1 直流双闭环调速系统的动态结构图接下来的问题就是对转速调节器ASR和电流调节器ACR的设计问题了，具体的设计方法和校验见（2）中的相关内容2）依据系统的动静态指标要求，计算调速系统的参数 根据以上的分析，为了满足无静差和快速响应，将转速调节环和电流调节环均选为PI控制器因此可设对应的表达式为： 需要确定参数：、、、，先用工程设计的一般方法进行设计：① 电流环的设计：已知： ，，，，，，，，，，，，，并且有减速比：电流环小时间常数之和：令，之后经过化简得到如下的流程框图： 图2 电流环化简的流程图令根据，查书上表3-1可选，从而可以解得：， 所以有： 所以最终有： 校核相关等效是否成立： 检验晶闸管整流装置传递函数的近似条件： 校验忽略反电动势变化对电流环的动态影响条件： 校验电流环小时间常数近似处理的条件： 通过校验发现，所设计的相关参数满足要求，从而可以满足电流环的超调量，并且也实现了无静差。

② 转速环的设计：根据以上已知以及ASR环的相关形式：首相需要将上述的电流环进行等效，等效为：，即约去二阶的小量转速环小时间常数之和：从而可将转速环化简成如下的框图： 图3 转速环化简的流程图取要求及，查书上表3-4可以选因此可得校核相关等效是否成立：首先校核电流环传递函数简化条件：校验电流环小时间常数近似处理的条件：通过校验发现，所设计的相关参数满足要求接下来需要校验转速超调量是否满足要求：选择了，所以，已知计算：，假设是空载启动，所以，且所以，可见是符合转速超调要求的3）利用Matlab对所设计的双闭环调速系统进行仿真实验为了便于观察和分析所设计的结果以及改变参数对结果的影响，需要用Matlab的simulink库进行仿真，分为电流环和速度环两部分进行仿真① 电流环的仿真： 根据以上设计的电流环，可以有以下的仿真流程图，如图4所示：图4 电流环Matlab仿真流程图 利用所设计的参数，运行程序后，可以在示波器内看到如下图5的结果：图5 电流环仿真结果 可见电流的，最终值并不等于最大电流，因为此处没有忽略逆反电动势E的反馈这相当于加入了一个斜坡输入，从而造成这里的型系统无法消除稳态误差，可见这里的稳态值，，因此可以得到，稍稍大于所要求的值。

但是当断开反电动势的反馈后，如下图6所示： 图6 去除了反电动势的反馈 得到的结果为：图7 忽略反电动势影响的仿真结果 可见电流的最终值达到了最大值，而且也可以得到对应的超调量为，恰好满足超调的要求，可见逆反电动势对系统的影响还是比较明显的系统的调节时间始终小于0.02s，满足小于0.1s的要求现在分析改变某些参数的情况：a. 当变小比例环节的比例时，如，仿真结果如下：图8 减小比例系数的结果 可见减小比例系数后，会导致系统的调节变慢，增大系统的超调量和调节时间，使系统稳定的时间更长 b．增大比例系数，如，仿真结果如下：图9 增大比例系数的结果 可见其峰值时间非常短，很快达到最大值，但是由于太快使得最大值的值比较大，从而也增加了超调量和调节时间 c. 增大积分环节系数，如，仿真结果如下：图10 增大积分环节系数的结果 从图上可以知道：，，可见稳态值更加接近于8A，而且超调量：，可见超调量增大了许多。

d. 减小积分环节系数，如，仿真结果如下：图11 增大积分环节系数的结果 可见其稳态值大于第一次达到的峰值，这主要是因为积分环节的系数过小，导致积分的速度太慢造成的 综合以上的几种情况的分析可以知道，原先所设计的各个参数使系统的性能很好，满足先前的所有要求增大比例环节系数，会使得系统的响应变快，但是会引起较大的超调；减小比例环节系数，会导致系统的调节变慢，增大系统的超调量和调节时间，使系统达到稳定的时间更长；增加积分环节系数，会使系统的稳态值更接近最大值，但是会增大超调和调节时间；减小积分环节的系数，会使得系统的稳态值比最大值更小，而调节时间和超调量会减小② 转速环的仿真：根据以上设计的转速环，可以有以下的仿真流程图，如图12所示：图12 转速环Matlab仿真流程图利用所设计的参数，运行程序后，在空载的条件下，可以在示波器内看到如下图13和图14的结果：图13 空载启动时电流的情况图14 空载启动时转速的情况这两个值由于数量级不同，因此将它们分开来画，当然也可以合并在一起画，如下图15所示： 图15 将电流与转速同时显示出来 可见这符合启动时电流迅速达到最大值匀加速启动，系统很快饱和，当达到期望转速后电流下降与负载电流相等，之后匀速的启动方式。

由图中可以看出，转速的最大值，而稳定值，因此超调量为，符合设计要求以上是空载时的情况，也可以考虑满载时和半满载时的情况，即修改的值4A或2A仿真出的图像如下图所示：图16 负载为4A时的仿真结果 可见转速达到400rpm的时间增长了，说明此时的加速度小了，因为加入了负载电流的负载电流的影响，电流的情况也发生了变化，我们可以看看电流的变化情况，如下图17所示：图17 驱动电流和负载电流的变化情况 如上图所示，黄线代表的是驱动电流，而紫线代表的是负载电流，可以看出驱动电流最大值是固定的8A，因此减去负载电流的4A产生的加速度就小了，而且驱动电流稳定之后的值是4A，保证了电机的匀速运动 同样地，半时的情况如下：图18 半载时（负载为2A）的仿真结果 转速达到400rpm比满载时稍快而比空载时慢，同样可以有电流的情况如下图19所示：图19 驱动电流和负载电流的变化情况 以上讨论的均是启动时就带负载的情况，现在我们讨论启动时空载而在1s的时候突加满负载的情况只需要让仿真环节中负载电流的阶跃信号在1s的时候产生即可得到的仿真结果如下图20所示：图20 在1s时加满负载的仿真结果 可以看出转速在空载时迅速达到了稳态值400rpm，而且在1s时有一个波动，并且在很短的时间里波动消失了，又回到了400rpm，体现了转速反馈能够快速响应的特点。

我们来看看电流的变化情况：图21 驱动电流和负载电流的变化情况 同样地，黄线代表驱动电流而紫线代表负载电流，可以看出驱动电流在1s时随负载电流有一个上升的过程，并且要超过负载电流，因为突加负载之后转速会。