带末端质量体的柔性梁系统动力学建模方法及其控制方法
【专利摘要】本发明是一种带末端质量体的柔性梁系统动力学建模方法及其控制方法。包括有如下步骤：1）建立系统动力学物理模型；2）对系统进行变形描述；3）建立有利于系统分析的双坐标系；4）受力分析；5）建立系统的动力学方程；6）选取边界约束条件；7）确定控制目标。本发明带末端质量体的柔性梁系统动力学建模方法，在梁末端无状态反馈检测情况下，能够使作快速、频繁点到点运动的柔性梁系统的末端质量体，在目标点处快速定位，为后续控制器的实现提供依据。本发明带末端质量体的柔性梁系统动力学控制方法方便实用。
【专利说明】带末端质量体的柔性梁系统动力学建模方法及其控制方法
【技术领域】
[0001]本发明涉及柔性梁系统动力学建模与控制方法领域，特别涉及一类带末端质量体的柔性梁系统动力学建模方法及其控制方法。属于带末端质量体的柔性梁系统动力学建模方法及其控制方法的创新技术。
【背景技术】
[0002]在机器人、高速进给机构和高速封装设备等工程【技术领域】中，针对这类柔性系统动力学的控制，人们往往关心运动机构末端的精确定位问题，而机构末端却难以安装检测装置以获得其响应。因此，我们可以提炼出这样一类物理模型:带末端质量体的柔性梁系统，在末端质量无状态反馈下，作快速、频繁点到点的运动，且要求末端质量在目标点处高精度定位。这种物理模型的特点:刚性材料的梁单元在一定高加速度、高速度驱动下，产生弹性变形，导致其末端质量体振动不稳，影响定位精度，但变形还不至于产生动力刚化。这类模型在许多领域中有着强烈的工程应用背景，因此建立无状态反馈下带末端质量的柔性梁系统的动力模型及控制方法的设计是极其重要的，可为梁末端定位控制及控制器的实现提供可靠依据。
[0003]目前，对带末端质量的柔性梁系统的建模方法主要基于两类基本方法:矢量力学法和分析力学法。应用成熟的是Lagrange方程法、Newton-Euler方法和Kane方法。通常的建模思路是以整个系统为研究对象，求出相关运动学量，然后再代入合适的动力学方程，如Lagrange方程、Jourdain变分原理、Hamilton变分原理、Kane方程等,再经过一系列非常繁琐复杂的数学推导后获得系统的动力学方程，推导过程冗长、建模效率不高，不利于动力学的分析以及后续控制算法的实现，且大部分在建模时考虑许多假设以及近似处理(如有限元法、假设模态法、奇异摄动法)，得到的模型有很大区别不同，和实际系统的误差大小也不同。从梁末端质量体的定位控制方法的角度上，目前大部分的研究都是采用经典的梁模型，然后将现有的高级控制算法(如最优控制、自适应算法、智能控制、变结构控制和预测控制)应用于模型的仿真研究，且算法中一般都会要求末端质量状态反馈控制，这与实际物理模型不符，难以满足控制的实时性要求，不易控制器的具体实现。因此，还是应该从系统实际受力情况出发，采用牛顿力学法，找到柔性梁末端质量与驱动之间的完整受力关系，明确物理意义，才能有利于控制器的实现，从而实现这类柔性梁系统从建模到末端质量体定位控制的整体方法。
【发明内容】
[0004]本发明的目的在于提供一种带末端质量体的柔性梁系统动力学建模方法。在梁末端无状态反馈检测情况下，采用该模型与控制方法能够使作快速、频繁点到点运动的柔性梁系统的末端质量体，在目标点处快速定位，为后续控制器的实现提供依据。
[0005]本发明另一目的是提供一种方便实用的带末端质量体的柔性梁系统动力学控制方法。[0006]本发明的技术方案是:本发明带末端质量体的柔性梁系统动力学建模方法，包括有如下步骤:
[0007]I)建立系统动力学物理模型；
[0008]2)对系统进行变形描述；
[0009]3)建立有利于系统分析的双坐标系；
[0010]4)受力分析；
[0011]5)建立系统的动力学方程；
[0012]6 )选取边界约束条件；
[0013]7)确定控制目标。
[0014]上述步骤I)建立系统动力学物理模型的具体方法是:弹簧钢材料的柔性梁，一端固定在滑块上，一端带质量块，滑块沿水平面左右运动，梁及末端质量体与水平面无接触摩擦，当滑块沿水平方向作高速点到点的运动时，梁及末端质量体也随之沿水平方向运动，并相对于滑块产生小范围的位移。
[0015]上述步骤2)对系统进行变形描述的具体方法是:在考虑符合系统运动特点的假设以及近似处理下，采用集中质量法对高速下系统的变形进行描述。
[0016]上述步骤3)建立有利于系统分析的双坐标系的具体方法是:将柔性梁系统的运动分解为滑块的刚体运动和梁及末端质量体的弹性变形运动两部分，采用双坐标系来描述两种运动，即刚体运动在惯性坐标系中表述，而弹性变形运动则在随动坐标系下表述。
[0017]上述步骤4)受力分析的具体方法是:以梁末端质量体为研究对象，采用牛顿力学法，分析高速运动下梁变形对末端质量体受力情况的影响。
[0018]上述步骤5)建立系统的动力学方程的具体方法是:根据受力分析，采用牛顿第二定律，以末端质量体的绝对位移为输出，以滑块的位移为输入，建立末端质量体的动力学方程。
[0019]上述步骤6)选取边界约束条件的具体方法是:当滑块快速运动至目标点处停止时，选取能表征梁末端质量体能准确停在平衡点处的物理量作为边界约束条件，来描述约束的运动限定作用和约束的力学特性。
[0020]上述步骤7)确定控制目标的具体方法是:根据边界约束条件，确定系统可以量化的控制目标。
[0021]本发明带末端质量体的柔性梁系统的动力学控制方法，根据控制目标，采用逆控制算法推导出基于开环时间序列的控制输入u (t)，使系统在这样的u (t)控制输入下能在无状态反馈下，满足控制目标。
[0022]本发明与现有技术相比，本发明具有如下显著效果:
[0023]I)本发明采用结构力学法，从一类高速度/高加速度的柔性运动机构末端定位控制工程中，提炼出一类带末端质量体的柔性梁系统的物理模型，梁末端质量体在无状态反馈检测情况下能快速定位。运用力学分析法对该梁模型进行动力学分析，建立了反应梁末端质量与梁驱动之间的完整受力关系的动力学方程，再根据系统实际运动特点，选取了方程中能表征梁末端质量体准确定位的物理量，作为边界约束条件，然后根据边界约束条件确定了系统可量化的控制目标，最后设计了一种无状态检测装置的开环时间序列控制输入u(t)来满足控制目标。[0024]2)—般对带末端质量体的柔性梁系统的研究主要包括:动力学建模理论以及末端定位控制策略两个方面。没有文献将该系统从动力学建模、分析，到梁末端定位控制整个流程完成，要么是采用经典的欧拉-伯努力梁模型、瑞利梁模型或Timoshenko梁模型，进行繁琐复杂的动力学方程的推导，所得系统动力学方程不能完全反应系统完整的受力情况；要么是将现有的高级控制算法应用到经典的动力学方程进行仿真研究，这样的反馈控制与实际系统物理模型不符，不能满足控制的实时性要求，以及控制器的实现。而本发明是对从动力学建模到梁末端质量体的定位控制两方面的内容都进行了整体、系统的推导和研究，为控制器的实现提供可靠的依据。
[0025]本发明是一种方便实用的带末端质量体的柔性梁系统动力学建模方法及其控制方法。
【专利附图】
【附图说明】
[0026]图1为本发明带末端质量体柔性梁系统物理模型；
[0027]图2本发明双坐标系下柔性梁及末端质量简化模型。
【具体实施方式】
[0028]实施例:
[0029]通过下面实施例对本发明作进一步详细阐述。
[0030]本发明带末端质量体的柔性梁系统动力学建模方法，包括有如下步骤:
[0031]I)建立系统动力学物理模型；
[0032]2)对系统进行变形描述；
[0033]3)建立有利于系统分析的双坐标系；
[0034]4)受力分析；
[0035]5)建立系统的动力学方程；
[0036]6)选取边界约束条件；
[0037]7)确定控制目标。
[0038](I)系统的变形描述
[0039]如图1所示的带末端质量体的刚体-柔性梁平动系统。滑块O可沿平面左右运动，梁及末端质量体固定在滑块上，梁及末端质量体与水平面无接触摩擦。当滑块沿水平方向作高速点到点的运动时，梁及末端质量体也随之沿水平方向运动，并相对于滑块产生小范围的位移。
[0040]系统作如下假设:(1)刚性梁变形前垂直于水平线，变形后仍为直线，且长度不变；(2)除末端外梁上各点应力不计；(3)末端质量体的运动轨迹与水平线平行；(4)每个点动周期前后，滑块O停止在水平线上；(5)变形为小量。
[0041](2)建立双坐标系
[0042]将柔性梁的运动分解为刚体运动和弹性变形运动两部分，其刚体运动在惯性坐标系中表述，而弹性变形运动则必须通过引入一随动坐标系才能有效地进行表述。为了研究本文算例的方便，将使用平动柔性梁及末端质量体简化模型，建立如图2所示的坐标体系。
[0043]其中OciXdyci为惯性坐标系,oxy为随体坐标系(以滑块与梁的连接点O为原点,滑块运动轨迹为X轴，系统静止时梁所在位置为I轴)，假设随体坐标系oxy的原点O在惯性坐标系OtlXtiytl中的坐标为(?, %)，则柔性梁的弹性变形及末端质量体的位移可在随体坐标系 oxy中描述。
[0044]梁及末端质量体的参数如下:L:梁原长；E:梁材料杨氏模量；IZ:梁截面惯性矩；
0:小范围运动角位移；m:末端质量体的质量。
[0045](3)系统动力学方程的建立
[0046]根据牛顿力学分析，末端质量体在运动过程中受到水平方向上的惯性力F。和梁在水平方向上的拉力Fx，如图2所示。取水平向右为正方向。在坐标系oxy中，根据牛顿第二定律，可得末端质量体的动力学方程:
[0047]Fx-F0=maW0 (I)
[0048]其中，aff0为质量体在oxy坐标系中水平方向上的加速度。
[0049]梁对末端质量在水平方向的拉力Fx，即为梁的弯曲应力，根据梁的扰度公式可知:
【权利要求】
1.一种带末端质量体的柔性梁系统动力学建模方法，其特征在于包括有如下步骤:1)建立系统动力学物理模型；2)对系统进行变形描述；3)建立有利于系统分析的双坐标系；4)受力分析；5)建立系统的动力学方程；6)选取边界约束条件；7)确定控制目标。
2.根据权利要求1所述的带末端质量体的柔性梁系统动力学建模方法，其特征在于上 述步骤I)建立系统动力学物理模型的具体方法是:弹簧钢材料的柔性梁，一端固定在滑块 上，一端带质量块，滑块沿水平面左右运动，梁及末端质量体与水平面无接触摩擦，当滑块 沿水平方向作高速点到点的运动时，梁及末端质量体也随之沿水平方向运动，并相对于滑 块产生小范围的位移。
3.根据权利要求1所述的带末端质量体的柔性梁系统动力学建模方法，其特征在于上 述步骤2)对系统进行变形描述的具体方法是:在考虑符合系统运动特点的假设以及近似 处理下，采用集中质量法对高速下系统的变形进行描述。
4.根据权利要求1所述的带末端质量体的柔性梁系统动力学建模方法，其特征在于上 述步骤3)建立有利于系统分析的双坐标系的具体方法是:将柔性梁系统的运动分解为滑 块的刚体运动和梁及末端质量体的弹性变形运动两部分，采用双坐标系来描述两种运动， 即刚体运动在惯性坐标系中表述，而弹性变形运动则在随动坐标系下表述。
5.根据权利要求1所述的带末端质量体的柔性梁系统动力学建模方法，其特征在于上 述步骤4)受力分析的具体方法是:以梁末端质量体为研究对象，采用牛顿力学法，分析高 速运动下梁变形对末端质量体受力情况的影响。
6.根据权利要求1所述的带末端质量体的柔性梁系统动力学建模方法，其特征在于上 述步骤5)建立系统的动力学方程的具体方法是:根据受力分析，采用牛顿第二定律，以末 端质量体的绝对位移为输出，以滑块的位移为输入，建立末端质量体的动力学方程。
7.根据权利要求1所述的带末端质量体的柔性梁系统动力学建模方法，其特征在于上 述步骤6)选取边界约束条件的具体方法是:当滑块快速运动至目标点处停止时，选取能表 征梁末端质量体能准确停在平衡点处的物理量作为边界约束条件，来描述约束的运动限定 作用和约束的力学特性。
8.根据权利要求1所述的带末端质量体的柔性梁系统动力学建模方法，其特征在于上 述步骤7)确定控制目标的具体方法是:根据边界约束条件，确定系统能量化的控制目标。
9.一种根据权利要求1所述的带末端质量体的柔性梁系统的动力学控制方法， 其特征在于根据控制目标，采用逆控制算法推导出基于开环时间序列的控制输入使系统在这样的《?控制输入下能在无状态反馈下，满足控制目标。
【文档编号】G05B17/02GK103558769SQ201310436830
【公开日】2014年2月5日 申请日期:2013年9月23日 优先权日:2013年9月23日
【发明者】王钦若, 张慧, 陈泓江 申请人:广东工业大学