《柔性驱动拱架机器人的建模与控制》由会员分享，可在线阅读，更多相关《柔性驱动拱架机器人的建模与控制（105页珍藏版）》请在金锄头文库上搜索。
1、华中科技大学 博士学位论文 柔性驱动拱架机器人的建模与控制 姓名：吴金波 申请学位级别：博士 专业：机械电子工程 指导教师：熊有伦;尹周平 20070515 华 中 科 技 大 学 博 士 学 位 论 文 华 中 科 技 大 学 博 士 学 位 论 文 I 摘摘 要要 本文研究了由同步带驱动的两轴拱架机器人的建模与控制问题，该类机器人提供 了两个相互垂直方向的运动，即沿梁运动的工作头（x 方向）和沿基座运动的梁（y 方向） 。两运动轴由于工作头在 x 轴的位置影响 y 轴的动力学特性而相互耦合，这一耦 合的产生是由于工作头在梁上的位置决定了 y 轴的质量分布，也即 y 轴运动的振动特 性。同步
2、带驱动系统将电机扭矩转换为两运动机构的线性驱动力，目的是使工作头尽 可能快地移动到目标位置并达到微米级的定位精度，但摩擦力的干扰、柔性梁和同步 带驱动系统的结构振动以及两运动机构之间的动力学耦合给这一控制目标的实现增加 了难度。目前，对同时具有驱动柔性和结构柔性的拱架机器人的研究还非常少。 首先，建立了拱架机器人 x 方向的动力学模型。为减小由同步带驱动的直线伺服 定位系统的振动，构造了双闭环控制系统，基于对系统数学模型的频域分析，将系统 振动分为低频振动和高频振动，这一区分对系统控制器的振动抑制策略非常重要。采 用低陷滤波器抑制系统的高频振动， 时滞滤波方法规划了合适的参考输入， 并结合 P
3、ID 控制实现快速的点到点运动并保持较小的残余振动。作为一种离线规划措施，此控制 器设计方法不需改变系统的任何硬件设施，能直接、有效地应用于现有的柔性驱动系 统中。其次，对拱架机器人的 y 向动力学进行了建模，模型考虑了系统的结构柔性与 驱动柔性以及两者之间的耦合作用。结构柔性具体体现为三种类型的振动：柔性梁在 刚性模态下的扭转振动，一端支撑于扭簧上的柔性梁的弯曲振动和简化为一移动振荡 子的贴装头的振动。基于系统的振动特性分析，提出了原型机的机械设计改进方法。 另外，分别研究了当工作头静止和移动时，柔性梁的 H输出反馈控制器设计方 法。当工作头在 x 方向固定时，应用线性矩阵不等式处理方法，给
4、出了系统的输出反 馈最优控制器。当工作头沿柔性梁移动时，拱架机器人的 y 向动力学模型可作为一线 性变参数系统处理。采用严格的等价变换将一类通用的线性变参数系统描述模型变换 为一简化模型，引入变 H性能将控制器的设计问题转换为满足线性矩阵不等式约束 的参数矩阵的求解问题，并给出了无需变参数变化率反馈的变增益全阶输出反馈 H 控制器设计方法。接着基于“ H性能覆盖”的概念，给出了保 H性能的插值方法。 仿真结果表明： H鲁棒控制器具有较小的调节时间且有效抑制了系统的振动和外部 干扰，且本文提出的变增益 H控制器设计方法能有效降低控制系统的保守性。然后， 针对普通变增益 H控制器设计过程复杂及权函
5、数选择困难等缺陷，采用回路成形方 法设计线性变参数系统的 H控制器，并将其应用于拱架机器人上。为了得到线性变 华 中 科 技 大 学 博 士 学 位 论 文 华 中 科 技 大 学 博 士 学 位 论 文 II 参数系统的连续控制器，通常对选定的变参数值设计线性控制器后，需要在变参数集 合内对这些线性控制器进行插值。本文给出了输出反馈线性控制器进行保稳定性插补 的充分条件，确保系统指数稳定的变参数变化率的上界也可在计算出控制器插值后得 出。由于此方法得出的控制器通常具有较高的阶数，为方便工程应用，对控制器进行 降阶处理，采用变增益 PID 控制器逼近高阶鲁棒控制器，从而将最终的 H控制结构 转
6、化为 PID+滤波器的常见形式。仿真结果验证了所提控制方法的有效性。 最后，介绍了拱架机器人在 RFID 封装设备中贴装模块的集成设计方法，并给出 了本文理论研究成果在该机器人中的实现方法。 关键词：关键词：拱架机器人，柔性定位系统，时滞滤波，线性变参数系统，变增益 H控制， 回路成形 华 中 科 技 大 学 博 士 学 位 论 文 华 中 科 技 大 学 博 士 学 位 论 文 III Abstract This dissertation mainly studies the modeling and control of two-axis belt-driven gantry robots
7、. Such robots provide two orthogonal motions, a head sliding along a beam (x-axis motion) and the beam sliding along a frame (y-axis motion). The two axes are coupled in the sense that the x-axis position influences the y-axis dynamics. This coupling arises because the location of the head on the be
8、am determines the mass distribution and hence the vibration characteristics for y-axis motion. Belt-pulley transmissions convert rotary motor torque into linear forces that drive the two-axis mechanism. The control objective is to move the gantry head to the target position as fast as possible, yet
9、also settle quickly with m accuracy. But friction force disturbances, structural vibrations in the gantry beam, transmission resonance and the coupling effect of the two-axis mechanism add difficulties to achieve this objective. At present, the study about the gantry robots which inclue both drive e
10、lasticity and structure flexibility is very few. Firstly, the modeling for the x-axis dynamic of the gantry robot is deduced. To suppress the vibration of the linear belt-driven system and improve the transient response performance, a double closed-loop control system is constructed and the mechanic
11、al resonance of the belt-driven system is analyzed and classified into two categories: low frequency resonance and high frequency resonance, which is crucial for guiding the design of controller. A notch filter is adopted to attenuate the high-frequency vibration. A new kind of input pre-shaping met
12、hod producing an appropriate reference profile accompanied with a PID controller is proposed for suppressing the low frequency vibration to ensure fast point-to-point motions with minimum residual vibration. As an off-line method, the proposed method can be easily and effectively adopted to the exis
13、ting elastic-driven system without any modification of the hardware setup. Next, the y-axis dynamic of the gantry robot is modeled. The model considers the structure flexibility and drive elasticity in addition to their coupling effect. The structure flexibility is embodied through three types of vi
14、bration, namely, the torsional vibration of a flexible beam in rigid motion mode, the transverse vibration of the flexibility beam with supports on torsional spring at one end and the vibration of the head which is simplified as a moving oscillator. Based on analysis of the vibration characteristic
15、in the system, the improvement measures of the mechanical design are proposed. In addition, the design method of the H output feedback controller for the flexible beam in y-direction with stationary and moving head is studied respectively. When the head is stationary in x-direction, the optimum outp
16、ut feedback controller of the system is devised based on the linear matrix inequality (LMI) approach. When the bonding head moves along 华 中 科 技 大 学 博 士 学 位 论 文 华 中 科 技 大 学 博 士 学 位 论 文 IV the flexible beam, the dynamic model of the gantry robot in y-direction can be considered as a linear parameter-varying (LPV) system. The general LPV system is transformed into a simplified model using strict equivalent transformation. Using parameter-varying H performance, the contro
