示教機械手伸缩臂计算机控制系统.docVIP

示教再现式机械手伸缩臂的 计算机控制系统 （本系统摘自熊世和编 机电系统计算机控制技术 1993年） 1．示教再现式机械手伸缩臂系统的工作原理 示教再现式机械手伸缩臂的基本结构如图1所示．其基本组成有四部分：1)阀控油缸．驱动源采用液压，具有出力大，响应快等优点，但系统复杂，它是控制系统的执行机构；2)示教再现操作器，是人机交道的接口；3）计算机，它具有记忆、比较和控制功能等；4）A／D和D/A接口板，简化为采样器和保持器。 图1 示教再现式机械手伸缩臂系统原理图 示教时，系统中的硬件开关片K1与A闭合，并通知计算机，计算机将软件开关K1′；接到A，系统处于开环工作状态．通过示教开关K1的正转、反转，可使机械手停在所需要的工作位置。这些数据存放于计算机寄存器中，但由于伺服放大器和电液伺服阀存在着零漂，所以一旦某一点示教结束，搬动开关K1至中间定位位置，系统转入闭环工作状态，即投入定位程序．此时，采样当前的位置值为y与前一个采样值为R进行比较，若误差；机械手动作(正转或反转)，以消除位置误差，一直到，机械手停止。其定位程序框图如图2所示。 记录：当示教的位置点需要保存下来，拨动开关K5，产生记录中断。当定 图2 示教机械手程序流图 位程序运行到“有否中断”时，计算机就马上转到记录程序工作，如图2所示。记录程序首先消除记录中断，然后取存储单元k，把第一个示教点的位置R1存入k单元保存，再取下一个存储单元k+1，为存入下一个示教点作准备。此外还记录存储点数n,当存入第一点时，n=1。随后转到定位程序，此时可进行第二个点的示教．若第二点也要存入，再拨动记录开关K5，第二个示教点R2存入k+l单元，n=2，并把存储单元k+2准备好．这样不断反复操作，可将所需要的示教点全部存入计算机的存储单元中去．记录完毕后，机械手停留在最后一个示教点位置上，恢复到定位程序运行． 再现：将示教动作再现是通过执行程序来完成的。当拨动执行开关K3，计算机得到中断信号，系统从定位程序转到执行程序．首先开中断，然后从存储器l中取出第一个示教点R1，并与机械手手臂当前位置y进行比较．若存在误差，则将误差，送入数字 控制器D(z)进行数据处理，然后输出。只要和不同时为零，机械手手臂就一直运动．由于D(z)的设计是采用无波纹有限拍的数字控制器，因而经过有限拍后能满足和同时为零，则机械手手臂停止运动。此时机械手手臂再现了第一个示教点的动作，其执行程序框图如图2所示。机械手手臂有定位点上的停留时间，是以的信号为准。考虑到系统的精度，取时开始计时，当规定停留的时间一到，计算机从k+l中取出第二个示教点，这样依次类推，直到最后一个示教点再现完毕；当最后一个示教点复现完毕，执行程序点数到，则又恢复k，再重新复现示教点，因此只要一执行，机械手手臂就周而复始地不断工作。 清零程序．有时需要更换记录中的示教点，首先要将存储器中的全部记录点清除．该任务是由清零程序完成。拨动清零点关K4，计算机得到清零中断信号，其运行由定位程序转到清零程序。首先清除清零中断，取存储单元k，k+l，k+2，…，判别这些存储单元的存数是否为零。若不为零，则存入零．然后再清除示教点的个数n，恢复k值，为新的示教作准备。清零结束，计算机运行又回到定位程序，其请零程序见图2。 返回程序：在机械手手臂运行过程中，如果需要它停下来，可以在任何时刻拨动返回开关K2，则机械手手臂从拨动K2，开始继续完成余下来的示教点。当执行完最后一个示教点后，机械手就停止再现，此时计算机转到定位程序运行，机械手就停在最后一个示教点位置上。 上面所介绍的示教再现机械手手臂伸缩系统的计算机程序仅仅是用于点到点的控制，没有涉及到运动轨迹的控制。 2．闭环手臂伸缩系统数字控制器D(z)的设计和实现 上面介绍了机械手手臂伸缩系统的工作原理，其中最核心的问题是控制器D(z)的设计，其次是计算机实现的控制算法．现在就这两个问题进行讨论． 1)D(z)的设计 ． 将图1所示的控制系统简化为如图3所示的方框图。图中 D(z)---数字控制器； ---零阶输出保持器； ---阀控油虹的传递函数。 图 3 机械手手臂伸缩控制系统框图 为了进行离散系统的设计，则首先将连续部分的传递函敷转化为z传递函数，采用零阶保持器法，把连续部分的传递函敷转化为z传递函数为 式中 其中ke根据所选要求的电磁阀确定。对象参数可以根据理论计算或试验确定。这里关键是采样周期T如何确定。对于采样周期T选择的基本原则是： (1)根据对象的