专利名称：化学机械抛光传输机器人的非线性模糊结合递归控制系统的制作方法
技术领域：
本发明涉及化学机械抛光技术领域，特别涉及一种化学机械抛光传输机器人的非线性模糊结合递归控制系统。
背景技术：
由抛光机的要求，研发一种专用的传输机器人是必要的。国外公司和研究机构在传输机器人及其关键技术的研究与开发，取得了丰硕的成果，并形成了完整的产品体系。但国内传输机器人的研究和开发相比于国外较落后，在精密自动传输人系统方面的研究也很少。目前，应用在国内IC生产线上的自动传输人系统几乎全部是从国外进口，而且国内的传输机器人在稳定性、可靠性和自动化程度上与国际水平有一定差距。掌握核心技术，相关研究成果在实际生产制造中得以应用，实现传输机器人产品的自主化，以替代维护不便且价格贵的进口产品。相关技术还可移植到其他IC装备中及设备间的晶元传输上，具有一定扩展性。IC设备中对机器人的控制精度要求非常高，由于传输机器人系统是高度非线性动态系统，加之摩擦、载荷变化及其他不确定干扰存在，使传输机器人系统的精确控制是一个难点。经典控制理论在处理复杂系统时，具有一定局限性。现代控制理论可适用于多输入多输出、非线性、分布参数控制系统，而最优控制是现代控制理论的一个重要组成部分， 其中线性二次型(linear quadratic,LQ)优化控制间题是最优控制理论中的一类非常重要的优化控制问题。其中得到的最优控制解是状态变量的线性函数，可构成反馈闭环，易于在工程上实现。LQ最优控制控制的对象是线性或可以线性化的系统，为了能更好的对非线性系统进行控制，并能得到更好的控制效果，可采用递归二次型最优控制方法进行控制。递归二次型最优控制方法即是在每个控制点上对系统进行实时线性化处理，再以LQ最优控制。模糊控制是一种智能的控制方法，不依赖数学模型，而PID或LQ控制都是建立在数学模型基础上的，都依赖数学模型。模糊控制具有很强鲁棒性和稳定性，适用于难以建立数学模的复杂系统。模糊控制算法是通过计算机完成人们用自然语言所描述的控制活动，模糊控制有许多良好的特征，它不需要事先知道对象的数学模型，具有系统响应快、超调小、过度过程时间短等优点。模糊控制器的基本组成由3个功能模块组成输入量得模糊化、模糊运算和模糊判断输出。通过模糊化、模糊推理和解模糊的过程，最终可以得到系统的模糊控制输出表。改进的模糊控制算法模糊控制器与PID或LQ控制器相比具有调节速度快、鲁棒性好等优点，但也有需要进一步改进和提高的地方。首先稳态精度欠佳是模糊控制的一个弱点，模糊控制与PID或IjQ控制相结合是一种常用的方法。为了能更好对具有非线性的传输机器人系统进行控制，并能得到更好的控制效果，对传输机器人系统采用采用模糊结合递归LQ优化控制。在系统启动时，需要大的转拒，若通过递归LQ控制需要计算得到，需要大量时间滞后并会控制时间也会加长，所以在初始间断可以通过模糊控制方式，给系统加入一个大的启动转矩使系统快速有效地到达一个速度值，然后再用采用递归LQ控制，使系统更好的达到控制效果。
发明内容
本发明的目的旨在至少解决上述技术缺陷之一，特别提出一种化学机械抛光传输机器人的非线性模糊结合递归控制系统，该系统可以缩短控制时间，提高系统的控制效果。为达到上述目的，本发明的实施例提出一种化学机械抛光传输机器人非线性模糊结合递归控制系统，包括上位机控制器、主控制器、运动控制器、检测器、多个伺服驱动器、 多个电机和编码器，其中，所述检测器，用于检测传输机器人的工作状态参数以生成检测信息；所述上位机控制器，用于接收用户输入的操作指令；所述编码器分别与所述运动控制器和多个所述电机相连，用于检测所述传输机器人的当前运动位移和当前运动角度；所述主控制器分别于所述上位机控制器和所述运动控制器相连，用于根据所述操作指令和所述检测器发送的检测信息生成传输机器人的运动指令，并将所述运动指令发送给所述运动控制器，所述运动控制器，用于在所述传输机器人启动时以模糊控制模式计算初始电机控制量，并在所述传输机器人平稳运行后以递归IiH尤化控制模式计算电机控制量；多个所述伺服驱动器与所述运动控制器相连，其中，每个所述伺服驱动器用于根据所述初始电机控制量或所述电机控制量计算相应电机的控制转矩；以及多个电机分别与所述多个伺服驱动器和所述传输机器人相连，其中，每个所述电机用于在相应的控制转矩的控制下驱动所述传输机器人运动。根据本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归控制系统， 在系统启动时采用模糊控制方式，给系统提供一个加大的启动转矩以使系统快速有效地达到接近目标值的速度值，然后采用递归LQ优化控制模式逐渐逼近目标值，从而提高了系统的控制速度，且使系统达到较好的控制效果。本发明附加的方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本发明的实践了解到。
本发明上述的和/或附加的方面和优点从下面结合附图对实施例的描述中将变得明显和容易理解，其中图1为根据本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归优化控制系的结构框图；图2为根据本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归优化控制系统框图；图3为根据本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归优化控制结构图；图4为根据本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归优化控制流程图；图5为模糊结合递归LQ控制水平位置和转矩曲线；
图6为模糊结合递归LQ控制水平速度曲线；图7为模糊结合递归LQ控制升降位置和转矩曲线；图8为模糊结合递归LQ控制升降速度曲线；图9为模糊结合递归LQ控制旋转角度曲线；图10为模糊结合递归LQ控制旋转角速度曲线；图11为模糊结合递归LQ控制旋转转矩曲线；图12为模糊结合递归LQ控制伸缩角度和位置曲线；图13为模糊结合递归LQ控制伸缩角速度曲线；以及图14为模糊结合递归LQ控制伸缩转矩曲线。
具体实施例方式下面详细描述本发明的实施例，所述实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的，仅用于解释本发明，而不能解释为对本发明的限制。在本发明的描述中，需要说明的是，除非另有规定和限定，术语“安装”、“相连”、 “连接”应做广义理解，例如，可以是机械连接或电连接，也可以是两个元件内部的连通，可以是直接相连，也可以通过中间媒介间接相连，对于本领域的普通技术人员而言，可以根据具体情况理解上述术语的具体含义。参照下面的描述和附图，将清楚本发明的实施例的这些和其他方面。在这些描述和附图中，具体公开了本发明的实施例中的一些特定实施方式，来表示实施本发明的实施例的原理的一些方式，但是应当理解，本发明的实施例的范围不受此限制。相反，本发明的实施例包括落入所附加权利要求书的精神和内涵范围内的所有变化、修改和等同物。为了使传输机器人启动运行平滑且实现快速启动，本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归控制系统采用非线性模糊结合递归W优化控制方法对机器人进行控制，即在传输机器人启动时采用模糊控制，平稳运行时采用递归LQ最优控制方法。采用的非线性策略为基于模糊结合递归LQ最优控制的方式，在递归LQ最优控制中加入了两条模糊规则。具体而言，在系统启动时，初始间断可以通过模糊控制方式，分别对水平运动、升降运动、旋转运动及伸缩运动都给一个给定的转矩值，即对系统加入一个大的启动转矩使系统快速有效地到达一个速度值，然后再用采用递归LQ控制，使系统更好的达到控制效果。递归二次型最优控制(递归LQ最优控制)的基本思想为在每个离散时刻k都会有一个与该时刻相对应的优化性能指标，通过极小化该优化性能指标求出相应该时刻的移动域控制输入。将获得k时刻的控制输入加到系统上，从而产生新的系统状态量 x(k+l)，并对系统在该点进行新的线性化处理，出现新的A(k)和B(k) (14)，再次通过极小化优化性能指标，状态反馈增益矩阵K (k) (16)可通过求解Riccati方程获得，进而获得新的控制输入(k)，如此反复递归迭代运行。递归优化控制是反复在线进行的，属于一种闭环控制方式。下面参考图1至图4描述根据本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归控制系统。其中，本发明实施例的传输机器人可以将晶圆在IC设备中进行传输。具体地，本发明实施例的传输机器人可以进行水平、升降、旋转、伸缩等运动，从而实现对晶圆的传输。需要说明的是，上述运动可以为机器人按照行为决策规则进行自主智能行为，也可以为按照用户及时下达的操作指令运动。如图1所示，根据本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归控制系统包括上位机控制器10、主控制器11、运动控制器3、检测器8、多个伺服驱动器 4、多个电机5和编码器7。检测器8用于检测传输机器人的工作状态参数以生成检测信息。其中，检测器8 包括光电传感模块、真空传感模块、压力传感模块和视觉传感模块。光电传感模块分别与传输机器人6和运动控制器3相连，用于检测传输机器人6 承载的晶圆的位置信息。真空传感模块分别与传输机器人6和运动控制器3相连，用于检测晶圆的吸附状态，即检测晶圆是否吸附在位的真空传感模块。压力传感模块分别与传输机器人6和运动控制器3相连，用于检测晶圆的在位信息和抓取压力信息，即检测晶圆是否吸附在位的真空传感模块。视觉传感模块分别与传输机器人6和运动控制器3相连，用于检测传输机器人6工作过程中的图像信息。上位机控制器10用于接收用户输入的操作指令。其中，操作指令包括程序存储的动作顺序表、动作指令、任务式指令。在本发明的一个示例中，上位机控制器10可以为数字运算操作电子系统的 PLC (Programmable Logic Controller，可编程逻辑控制器)。编码器7分别与运动控制器3和多个电机5相连，用于检测传输机器人的当前运动位移和当前运动角度。主控制器11分别与上位机控制器10和运动控制器3相连，用于根据操作指令和检测信息生成传输机器人6的运动指令，并将运动指令发送给运动控制器3。在本发明的一个示例中，主控制11为嵌入式计算机系统，例如，型号可以为 PC104。运动控制器3用于在传输机器人6启动时以模糊控制模式计算初始电机控制量， 并在传输机器人6平稳运行后以递归LQ优化控制模式计算电机控制量。在本发明的一个示例中，运动控制器3可以为DSP(Digital Signal ftOcessor，数字信号处理器)，例如DSP2812。在本发明的一个实施例中，如图3所示，运动控制器3包括动作发生器31、决策控制器32、模糊控制器33、递归优化控制器沈和决策选择器25。动作发生器31与检测器8相连，用于检测检测器8反馈的检测信息，并将检测信息发送给主控制器11。其中，动作发生器31的设计方法包括查表、模糊逻辑和专家系统算法等。决策控制器32用于接收并解析运动指令以得到传输机器人6的目标运动位移和目标运动角度，以及接收来自编码器7的当前运动位移和当前运动角度。模糊控制器33用于在启动时以模糊控制模式计算初始电机控制量，从而在系统启动时，分别对水平运动、升降运动、旋转运动及伸缩运动均提供一个给定的转矩值，即对系统加入一个较大的启动转矩使系统快速有效地到达一个速度值。
递归优化控制器沈用于将当前运动位移和当前运动角度与目标运动位移和目标运动角度进行比较以得到当前位移误差和当前角度误差，根据当前位移误差和当前角度误差计算多个伺服驱动器4的多个电机控制量。决策选择器25选择性地与模糊控制器33和递归优化控制器沈相连，用于选择以模糊控制模式或递归LQ优化控制模式工作。多个伺服驱动器4与运动控制器3相连。其中，每个伺服驱动器4用于根据初始电机控制量或电机控制量计算相应电机的控制转矩。在本发明的一个示例中，伺服驱动器4为安川电机伺服驱动器，可以通过电机反馈实现电机5的力矩和速度控制，即伺服驱动器4通过电机电枢电流反馈闭环，实现电机5 的速度控制。多个电机5分别与多个伺服驱动器4和传输机器人6相连。其中，每个电机5用于在相应的控制转矩的控制下驱动传输机器人6运动。在本发明的一个实施例中，电机5为交流电机，且电机5可以为中惯量小容量的高精度安川交流电机，该电机为带减速器的伺服型交流电机，具有高功率快速响应率其中，多个所述电机包括水平电机、升降电机、旋转电机和伸缩电机。其中，水平电机用于驱动传输机器人6将承载的晶圆在水平方向上运动以产生水平位移，升降电机用于驱动传输机器人6将晶圆在竖直方向上运动以产生升降位移，旋转电机用于驱动传输机器人6将晶圆进行旋转运动以产生旋转角度，伸缩电机用于驱动传输机器人6将晶圆进行伸缩运动以产生伸缩角度。如图1所示，本发明实施例的非线性模糊结合递归控制系统还包括显示屏1，其中，显示屏1用于显示检测器8的检测信息和用户输入的操作指令。在本发明的又一个实施例中，本发明实施例的非线性模糊结合递归控制系统还包括报警装置2，其中报警装置2用于在检测信息或操作指令有误时，发出报警信号。其中，报警装置2可以为扬声器。下面对本发明实施例的化学机械抛光传输机器人的非线性模糊结合递归控制系统的递归控制过程进行详细描述。机器人的主控制器11经过数据转换器、串口以及USB 口，由运动控制器3和上位机控制器10读取各个传感器反馈的检测信息和用户的操作指令，并将检测信息和用户的操作指显示在液晶触摸屏1上。当检测信息或用户的操作指令有误时，通过扬声器2报警。 主控制器11接收来至上位机控制器10以及液晶触摸屏1的指令信息，定时参照用户操作指令和传感器反馈信息，通过决策控制来将机器人水平移动、升降、旋转、伸缩命令下达给运动控制器3。主控制器11的运动行为决策算法为动作发生器31参考用户命令或视觉信息计算出期望水平运动的位移、升降运动的位移、旋转角度和伸缩位置控制命令，决策控制器32 根据机器人运动的状况判断是否执行期望控制命令。如果运动状态与期望状态一致，则不需要对传输机器人6的动作进行调整；否则需要对传输机器人6的动作进行调整。运动控制器3执行主控制器11指令，传输机器人6的水平和升降移动方向由编码器7反馈回信号，调节传输机器人到指定位置。传输机器人6旋转移动方向由光电传感模块、真空传感模块和压力传感模块以及编码器7反馈信号。
动作发生器31接收来自输入设备(例如触摸显示屏)的用户操作命令。动作发生器监测各个传感器反馈信息，并定时参照用户命令和传感器反馈信息，通过决策控制器 32运动行为决策算法计算出传输机器人6的水平位移、升降位移、旋转角度及伸缩角度控制命令，下达给伺服驱动器4。在一个运动控制周期内，决策控制器32读取传输机器人6的壳体和伸缩臂的编码器7与视觉传感器9的反馈信号，并与期望值比较得到位移和角度的误差信号。具体地，运动控制器3读取电机编码器7的反馈信号，计算出传输机器人6的水平移动位移、升降移动位移、旋转角度及伸缩角度，与主控制器11给定的控制命令对比得出误差信号。即，运动控制器3将当前运动位移和当前运动角度与解析主控制器11的控制命令得到的目标运动位移和目标运动角度进行比较，得到当前误差位移和当前误差角度。，运动控制器3根据误差信号按照模糊结合递归LQ优化控制算法计算出电机的控制量，发送给伺服驱动器4执行。伺服驱动器4执行运动控制器3的指令，通过读取编码器(7)的反馈信号，根据误差信号，伺服驱动器4计算相应电机5的控制转矩，控制交流电机5运动，通过交流电机5 带动传输机器人6，使机器人旋转到指定角度.在本发明的一个实施例中，视觉传感器9将传输机器人6的运动信息反馈回上位机控制器10，从而可对传输机器人6进行工作状态的监测。采用模糊控制模式或者递归LQ优化控制方式是通过选择器25决定的。在启动时刻，选择器25选择模糊控制器33，从而执行模糊控制模式。在模糊控制下，模糊控制器 3分别对水平运动、升降运动、旋转运动及伸缩运动都给一个给定的转矩值，将给定的控制量U1 (k)，U2 (k)，U3 (k)，U4 (k)，发送给伺服驱动器4，分别获得水平电机控制转矩τ i (k)，升降电机控制转矩τ 2(k)，旋转电机控制转矩τ 3(k)，伸缩电机控制转矩T4(k)，并将获得的 τ工(k)，τ 2 (k)，τ 3 (k)，τ 4 (k)。将上述控制转矩实施到非线性化学机械抛光传输机器人系统上产生新的 k+Ι 时刻的状态量 x(k+l)，x(k+l), z(k+l), z(k+l), θ (k+1)，θ (k+1), θ i (k+1)，θ工(k+1)，反馈到系统控制输入端，继续对下一个离散时刻进行类似的过程，从而给系统加入一个大的启动转矩使系统快速有效地到达一个速度值。在递归LQ优化控制模式下，采用递归LQ控制算法实现，需先对系统进行线性化处理获得得到当前的第一系统矩阵A' (k)和第二系统矩阵B' (k))，求解最优控制律对里卡蒂Riccati方程进行求解，获得状态反馈增益矩阵K (k) (17)，进而求出k时刻的最优输入控制量 U1 (k)，U2 (k)，U3 (k)，U4 (k)，将计算电机的控制量 U1 (k)，U2 (k)，U3 (k)，U4 (k)，发送给伺服驱动器4。由伺服驱动器4分别计算水平电机控制转矩τ Jk)，升降电机控制转矩 τ 2(k)，旋转电机控制转矩τ 3(k)，伸缩电机控制转矩τ4(10，并将获得的τ (k) , τ 2 (k)， x3(k), τ 4(k)，实施到非线性化学机械抛光传输机器人系统上产生新的k+1时刻的状态量 χ (k+Ι), χ (k+1), ζ (k+1), ζ (k+1), θ (k+1), θ (k+1), θ ^k+1), θ i (k+1)，反馈到系统控制输入端，继续对下一个离散时刻进行类似的过程，电机5带动传输机器人6最后到达期望的水平位移xd，升降位移zd，旋转角度θ d及伸缩角度θ /，从而实现实时的对传输机器人6的模糊结合递归LQ最优控制。图5为模糊结合递归LQ控制水平位置(position)和转矩(force)曲线，其中，A 为水平位置曲线，B为转矩曲线。图6为模糊结合递归LQ控制水平速度(speed)曲线。图7为模糊结合递归LQ控制升降位置(position)和转矩(force)曲线，其中，A为升降位置 曲线，B为转矩曲线。图8为模糊结合递归LQ控制升降速度(speed曲线。图9为模糊结 合递归LQ控制旋转角度曲线。图10为模糊结合递归LQ控制旋转角速度曲线。图11为模 糊结合递归LQ控制旋转转矩曲线。图12为模糊结合递归LQ控制伸缩角度和位置曲线，其 中，A为位置曲线，B为伸缩角度曲线。图13为模糊结合递归LQ控制伸缩角速度曲线。图 14为模糊结合递归LQ控制伸缩转矩曲线。首先，将传输机器人的非线性系统，通过解耦处理，进行泰勒级数展开，去掉高阶 次项影响，并实时线性化，从而获得传输机器人的线性状态方程，并将其分解为水平移动、 升降运动、旋转及伸缩运动四个单输入子系统。根据传输机器人的机械系统的特点和参数， 建立其数学模型，线性化处理获得线性状态空间方程X = AX+ BuY = CX+Du其中，X= [xxzzθθθ1θ1 ]τ，γ = [χ z θ θ1]t，u= [T1T2T3T4]T
权利要求
1.一种化学机械抛光传输机器人的非线性模糊结合递归控制系统，其特征在于，包括 上位机控制器、主控制器、运动控制器、检测器、多个伺服驱动器、多个电机和编码器，其中，所述检测器，用于检测传输机器人的工作状态参数以生成检测信息； 所述上位机控制器，用于接收用户输入的操作指令；所述编码器分别与所述运动控制器和多个所述电机相连，用于检测所述传输机器人的当前运动位移和当前运动角度；所述主控制器分别与所述上位机控制器和所述运动控制器相连，用于根据所述操作指令和所述检测信息生成传输机器人的运动指令，并将所述运动指令发送给所述运动控制器；所述运动控制器，用于在所述传输机器人启动时以模糊控制模式计算初始电机控制量，并在所述传输机器人平稳运行后以递归LQ优化控制模式计算电机控制量；多个所述伺服驱动器与所述运动控制器相连，其中，每个所述伺服驱动器用于根据所述初始电机控制量或所述电机控制量计算相应电机的控制转矩；以及多个电机分别与所述多个伺服驱动器和所述传输机器人相连，其中，每个所述电机用于在相应的控制转矩的控制下驱动所述传输机器人运动。
2.如权利要求1所述的非线性模糊结合递归控制系统，其特征在于，所述运动控制器包括动作发生器，所述动作发生器与所述检测器相连，用于检测所述检测器反馈的所述检测信息，并将所述检测信息发送给所述主控制器；决策控制器，所述决策控制器用于接收并解析所述运动指令以得到所述传输机器人的目标运动位移和目标运动角度，以及接收来自所述编码器的所述当前运动位移和当前运动角度；模糊控制器，所述模糊控制器用于在启动时以模糊控制模式计算所述初始电机控制量；递归优化控制器，所述递归优化控制器用于将所述当前运动位移和当前运动角度与所述目标运动位移和所述目标运动角度进行比较以得到当前位移误差和当前角度误差，根据所述当前位移误差和所述当前角度误差计算多个所述伺服驱动器的多个电机控制量；以及决策选择器，所述决策选择器选择性地与所述模糊控制器和所述递归优化控制器相连，用于选择以所述模糊控制模式或递归LQ优化控制模式工作。
3.如权利要求1所述的非线性模糊结合递归控制系统，其特征在于，所述递归优化控制器还用于根据对所述当前运动位移和所述当前运动角度进行线性化处理以得到当前时刻的第一系统矩阵和第二系统矩阵，并根据所述第一系统矩阵和所述第二系统矩阵判断系统是否可控。
4.如权利要求3所述的非线性模糊结合递归控制系统，其特征在于，所述递归优化控制器在判断系统可控时，求解里卡蒂Riccati方程获得状态反馈增益矩阵K' (k)，其中，所述状态反馈增益矩阵K' (k)用于表示所述当前位移误差和所述当前角度误差，以及根据所述状态反馈增益矩阵K' (k)计算所述传输机器人的当前电机控制量。
5.如权利要求1所述的非线性模糊结合递归控制系统，其特征在于，所述检测器包括 光电传感模块，所述光电传感模块分别与所述传输机器人和所述运动控制器相连，用于检测所述传输机器人承载的晶圆的位置信息；真空传感模块，所述真空传感模块分别与所述传输机器人和所述运动控制器相连，用于检测所述晶圆的吸附状态；压力传感模块，所述压力传感模块分别与所述传输机器人和所述运动控制器相连，用于检测所述晶圆的在位信息和抓取压力信息；以及视觉传感模块，所述视觉传感模块分别与所述传输机器人和所述运动控制器相连，用于检测所述传输机器人工作过程中的图像信息。
6.如权利要求1所述的非线性模糊结合递归控制系统，其特征在于，还包括 显示屏，用于显示所述检测器的检测信息和所述用户输入的操作指令。
7.如权利要求1-6中任一项所述的非线性模糊结合递归控制系统，其特征在于，还包括报警装置，用于在所述检测信息或所述操作指令有误时，发出报警信号。
8.如权利要求1-7中任一项所述的非线性模糊结合递归控制系统，其特征在于，多个所述电机包括水平电机，用于驱动所述传输机器人将承载的晶圆在水平方向上运动以产生水平位移；升降电机，用于驱动所述传输机器人将所述晶圆在竖直方向上运动以产生升降位移； 旋转电机，用于驱动所述传输机器人将所述晶圆进行旋转运动以产生旋转角度；以及伸缩电机，用于驱动所述传输机器人将所述晶圆进行伸缩运动以产生伸缩角度。
9.如权利要求1或8所述的非线性模糊结合递归控制系统，其特征在于，所述伺服驱动器将对应的所述电机的电枢电流反馈至所述电机以控制所述电机的转速。
10.如权利要求1所述的非线性模糊结合递归控制系统，其特征在于，所述上位机控制器为可编程逻辑控制器。
全文摘要
本发明提出一种化学机械抛光传输机器人的非线性模糊结合递归控制系统，包括上位机控制器、主控制器、运动控制器、检测器、多个伺服驱动器、多个电机和编码器，检测器用于检测传输机器人的工作状态参数以生成检测信息；上位机控制器用于接收操作指令；编码器用于检测传输机器人的当前运动位移和当前运动角度；主控制器用于生成传输机器人的运动指令；运动控制器用于在传输机器人启动时以模糊控制模式计算初始电机控制量并在传输机器人平稳运行后以递归LQ优化控制模式计算电机控制量；每个伺服驱动器用于根据初始电机控制量或电机控制量计算相应电机的控制转矩；多个电机，每个电机用于在相应的控制转矩的控制下驱动传输机器人运动。
文档编号G05B13/04GK102540896SQ20121005060
公开日2012年7月4日 申请日期2012年2月29日 优先权日2012年2月29日
发明者何永勇, 赵建伟, 路新春 申请人:清华大学