用于点到点小位移平动的柔性机械梁末端快速定位算法
【技术领域】
[0001 ] 本发明属于数控机床控制的技术领域，具体涉及一种用于点到点小位移平动的柔 性机械梁末端快速定位算法。
【背景技术】
[0002] 目前，在高速数控冲床进给机构，高速贴片机和高速封装设备中，柔性运动机构末 端可视为平动柔性机械梁系统，其作高速、高加/减速运动时可处理为：机械梁在平面内作 快速、频繁的点到点的小位移运动，并要求梁末端质量在目标点处高精度定位。对高速平动 柔性梁系统的要求不仅仅能够达到高速运动，而且要求瞬时达到高速，瞬时准确停止，所以 要求很大的加速度及很高的定位精度。传统的做法是（1)采用图像技术或者激光技术等非 接触式测量方式，对机械梁末端的运动状态进行测量，以构成闭环系统，对梁末端定位进行 控制；（2)使用压电陶瓷对机械梁的弹性变形进行补偿，以达到梁末端的定位控制。
[0003] 由于在机械梁模拟的实际工程中，系统一般都难以安装检测装置以准确获得梁末 端的响应；另外，第（1)方案中增加了测量梁末端状态的传感器，成本增加的同时，由于反 馈检测元件的加入，也会对精密定位系统带来相应的干扰，因此不能实施第（1)方案。如果 要采用传统的方案使平动梁系统瞬时达到高速，梁末端能瞬时停止在目标点处，就要采用 第（2)方案，然而压电陶瓷对抗弯刚度相近的构件振动补偿时效果具有一定的补偿能力， 而当构件的抗弯刚度大于压电陶瓷，其补偿效果显著减弱，且由于压电陶瓷是脆性材料，它 对相应构件的补偿范围也是有限的，因此无法满足不同材质的机械梁运动时其末端快速定 位控制。
[0004] 因此，需要设计新的、实用的用于点到点小位移平动的柔性机械梁末端快速定位 控制算法。
[0005] 上述论述内容目的在于向读者介绍可能与下面将被描述和/或主张的本发明的 各个方面相关的技术的各个方面，相信该论述内容有助于为读者提供背景信息，以有利于 更好地理解本发明的各个方面，因此，应了解是以这个角度来阅读这些论述，而不是承认现 有技术。
【发明内容】
[0006] 本发明的目的在于避免现有技术中的不足而提供一种用于点到点小位移平动的 柔性机械梁末端快速定位算法，其可对柔性机械梁末端进行快速定位。
[0007] 本发明的目的通过以下技术方案实现：
[0008] 提供一种用于点到点小位移平动的柔性机械梁末端快速定位算法，其中机械梁由 伺服电机驱动，包括如下步骤：
[0009]S1、枏据下沭公式计算机械梁的振动周期T。
[0010]
⑴
[0011] 其中，m为机械梁及末端质量的总质量，1为机械梁的梁长，E为机械梁材料的杨氏 模量，Iz为机械梁的截面惯性矩；
[0012]S2、将点到点运动一个周期的时间等分成η等份，η的取值为：
[0013] η=Τ。 (2)
[0014] S3、计算每等分点处的速度Vi
[0015] 机械梁作快速一个点到点的运动周期内，每一等分点i(0彡i彡n-1)处的速度Vi 根据下述公式计算如下：
[0016]
[0017] 其中，S为机械梁从起始点到目标点处的位移，Vl为机械梁从第0等分点到第 (n-1)等分点的速度；
[0018]S4、计算伺服电机发出的脉冲数I
[0019] 在每一个等分点处，伺服电机发一次脉冲，发出的脉冲数^根据下述公式计算 为：
[0020] (4)
[0021] 其中，Wi为第i等分点处伺服电机发出的脉冲数，p为伺服电机走1mm需要发送的 脉冲数；
[0022] S5、根据下述公式插补计算最后一个等分点η处的脉冲数Wn
[0023]
(5)
[0024] 其中，Wn为第η等分点处伺服电机发出的脉冲数。
[0025] 其中，在步骤S2中，机械梁系统在平面内作快速、频繁的从起始点到目标点的小 位移运动，将这一段小位移的运动看作一个运动周期。
[0026] 由于采用了上述的结构，本发明的有益效果：本发明不仅可以使得系统控制器实 现更加简单，操作更加容易可靠，而且由于无需增加额外的硬件结构，系统成本会相应的降 低，后期也更易维护，能广泛应用于可等效为柔性梁结构的系统，作点到点小位移运动的快 速准确定位控制。
【附图说明】
[0027] 利用附图对本发明作进一步说明，但附图中的实施例不构成对本发明的任何限 制，对于本领域的普通技术人员，在不付出创造性劳动的前提下，还可以根据以下附图获得 其它的附图。
[0028] 图1是平动柔性机械梁系统的结构俯视图。
[0029] 图2是机械梁控制系统框图。
[0030] 图3是本发明算法的流程图。
【具体实施方式】
[0031] 为了使本领域的技术人员更好地理解本发明的技术方案，下面结合附图和具体实 施例对本发明作进一步详细的描述，需要说明的是，在不冲突的情况下，本申请的实施例及 实施例中的特征可以相互组合。
[0032] 如图1所示，本发明应用的平动柔性机械梁系统中，滑块0沿水平面左右运动，机 械梁一端固定在滑块上，另一端无缝隙连接一质量体。当滑块沿水平方向作快速点到点的 小位移运动时，梁带着末端质量也随之沿水平方向运动，并相对于滑块产生振动。整个系统 的动力源在于伺服电机，控制目标点在机械梁末端质量。如图2所示，机械梁控制系统中， 伺服电机直接驱动机械梁系统中的滑块〇,滑块〇与末端质量之间还有机械梁机构，因此要 使得系统作点到点小位移运动时，末端质量在目标点处准确停止，必须对伺服电机进行控 制算法的设计。
[0033] 如图3所示，本发明的控制算法包括下述步骤：
[0034] S1、机械梁的振动周期T。的计算：
[0035]
(1)
[0036] 其中，m为梁及末端质量的总质量；1为机械梁的梁长；E为机械梁材料的杨氏模 量；Iz为机械梁的截面惯性矩。
[0037] S2、将点到点运动一个周期的时间进行等分
[0038] 机械梁系统在平面内作快速、频繁的从起始点到目标点的小位移运动，将这一段 小位移的运动看作一个运动周期，将这个运动周期的时间分成η等份，η的取值为：
[0039] η=Τ。 (2)
[0040] S3、计算每等分点处的速度Vi
[0041] 机械梁系统作快速一个点到点的运动周期内，每一等分点i(0彡i彡n-1)处的速 度计算如下：
[0042]
[0043] 其中，s为机械梁从起始点到目标点处的位移，Vl为机械梁系统从第0等分点到第 (n-1)等分点的速度。
[0044] S4、计算伺服电机每一步发出的脉冲数％
[0045] 机械梁系统是由伺服电机驱动的，在每一个等分点处，伺服电机发一次脉冲，发出 的脉冲数I计算为：
[0046]
(4.)
[0047] 其中，Wi为第i等分点处伺服电机发出的脉冲数，p为伺服电机走1mm需要发送的 脉冲数。
[0048] S5、插补计算最后一个等分点η处的脉冲数Wn
[0049]
(5)
[0050] 其中，Wn为第η等分点处伺服电机发出的脉冲数。
[0051] 上面的描述中阐述了很多具体细节以便于充分理解本发明，但是，本发明还可以 采用其他不同于在此描述的其他方式来实施，因此，不能理解为对本发明保护范围的限制。
[0052] 总之，本发明虽然例举了上述优选实施方式，但是应该说明，虽然本领域的技术人 员可以进行各种变化和改型，除非这样的变化和改型偏离了本发明的范围，否则都应该包 括在本发明的保护范围内。
【主权项】
1. 一种用于点到点小位移平动的柔性机械梁末端快速定位算法，其中机械梁由伺服电 机驱动，其特征在于，包括如下步骤： 51、 根据下述公式计算机械梁的振动周期T。丨 其中，m为机械梁及末端质量的总质量，1为机械梁的梁长，E为机械梁材料的杨氏模 量，Iz为机械梁的截面惯性矩； 52、 将点到点运动一个周期的时间等分成η等份，η的取值为： n = T0 (2) 53、 计算每等分点处的速度Vi 机械梁作快速一个点到点的运动周期内，每一等分点i (〇彡i彡n-Ι)处的速度\根 据下述公式计算如下：其中，s为机械梁从起始点到目标点处的位移，V1为机械梁从第0等分点到第（n-Ι)等 分点的速度； 54、 计算伺服电机发出的脉冲数W1 在每一个等分点处，伺服电机发一次脉冲，发出的脉冲数W1根据下述公式计算为：其中，W1为第i等分点处伺服电机发出的脉冲数，ρ为伺服电机走Imm需要发送的脉冲 数； 55、 根据下述公式插补计算最后一个等分点η处的脉冲数Wn其中，Wn为第η等分点处伺服电机发出的脉冲数。2. 根据权利要求1所述的用于点到点小位移平动的柔性机械梁末端快速定位算法，其 特征在于：在步骤S2中，机械梁系统在平面内作快速、频繁的从起始点到目标点的小位移 运动，将这一段小位移的运动看作一个运动周期。
【专利摘要】本发明公开了一种用于点到点小位移平动的柔性机械梁末端快速定位算法。包括如下步骤：S1、计算机械梁的振动周期T0；S2、将点到点运动一个周期的时间等分成n等份，n的取值为：n＝T0；S3、计算每等分点处的速度vi；S4、计算伺服电机发出的脉冲数Wi；S5、插补计算最后一个等分点n处的脉冲数Wn。本发明不仅可以使得系统控制器实现更加简单，操作更加容易可靠，而且由于无需增加额外的硬件结构，系统成本会相应的降低，后期也更易维护，能广泛应用于可等效为柔性梁结构的系统，作点到点小位移运动的快速准确定位控制。
【IPC分类】G05B19/19
【公开号】CN105425723
【申请号】CN201510812488
【发明人】张慧, 王钦若
【申请人】广东工业大学
【公开日】2016年3月23日
【申请日】2015年11月19日