论文部分内容阅读
集成电路(IC)制造装备是电子信息产业的核心,是推动国民经济和社会信息化发展的高新技术之一。晶圆传输系统是IC装备中必不可少的组成部分,其中的晶圆传输机器人是晶圆传输系统的关键部件,主要承担着晶圆的精确定位与快速、平稳搬运任务。本课题结合国家973项目《超大规模集成电路制造装备基础问题研究》(2009CB724206),研究晶圆传输机器人的平稳精确轨迹控制方法。在轨迹跟踪控制方面,晶圆传输机器人在取放晶圆的过程中主要由两个关节联动实现对末端轨迹的跟踪,为了防止晶圆盒和晶圆之间相互摩擦,需要尽量减小末端手的轮廓误差。本文在分析晶圆传输机器人的动力学和运动学之后,基于任务空间的轮廓误差模型,分析了轮廓误差和传统的跟踪误差的区别,并将其引入到机器人的控制当中。采用交叉耦合同步控制结构,推导了机器人轮廓误差传递函数,并根据实际控制硬件对其进行了简化,最后采用PI控制器对机器人进行控制。该控制结构在每个采样周期对各关节位置指令进行轮廓误差补偿,改善了驱动关节的同步性,提高了跟踪轨迹的轮廓精度。在平稳抑制控制方面,由于晶圆传输机器人需要适应洁净环境的要求,因此在其结构设计中采用了同步带以及谐波传动,为了抑制这些柔性环节带来的末端手的振动,本文在对机器人进行柔性关节、刚性连杆动力学建模的基础上,采用开环的输入整形技术对其进行抑制。推导了三脉冲整形的一般表达式,对其进行了灵敏度分析,采用灵敏区间最大的非对称整形以及ZV整形对两个关节进行了振动抑制。为了将振动抑制方法结合到轮廓误差控制中,分析了不同空间下输入整形的效果,最终采用笛卡尔空间下的整形对末端手进行振动抑制。最后搭建了实验系统,对机器人进行了轨迹跟踪控制实验和振动抑制实验。实验证明,基于轮廓误差的交叉耦合同步控制有效的提高了机器人驱动关节的同步性,结合笛卡尔空间下的输入整形技术,有效的减小了传动柔性引起的末端手振动,实现了末端手的平稳精确轨迹控制。