一种冗余驱动并联机床死点规避系统及方法技术方案

本发明专利技术公开了一种冗余驱动并联机床死点规避系统及方法，系统包括与三个缩杆组的伺服电机相连的测速发电机、光电编码器；与冗余滑块相连的直线感应同步器，以及死点监测处理器；测速发电机用于采集三个伸缩杆组的伺服电机的输出转速；光电编码器用于采集三个伸缩杆组的丝杠转过的圈数；直线感应同步器用于采集冗余滑块在其导轨上的位置；死点监测处理器用于判定并联机构是否接近死点位置，控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置；方法包括获得三个伸缩杆组的输出转速、丝杠转过的圈数、冗余滑块在导轨上的坐标；计算动平台速度；判定是否接近死点位置；控制各伸缩杆组及冗余滑块运动规避死点位置。本发明专利技术可预测死点和规避死点。

A Dead Point Avoidance System and Method for Redundant Driven Parallel Machine Tools

The invention discloses a dead-point avoidance system and method of a redundant driven parallel machine tool, which includes a speed measuring generator and photoelectric encoder connected with servo motors of three telescopic pole groups, a linear induction synchronizer connected with redundant slider and a dead-point monitoring processor, a speed measuring generator used to collect the output speed of servo motors of three telescopic pole groups, and a photoelectric encoder used for acquisition. The number of turns of the lead screw with three groups of expansion rods; the linear induction synchronizer is used to collect the position of the redundant slider on its guide rail; the dead-point monitoring processor is used to determine whether the parallel mechanism is close to the dead-point position, control the expansion of the three groups of expansion rods and the movement direction of the redundant slider to avoid the dead-point position; the method includes obtaining the output speed of the three groups of expansion rods and the circle of the screw rotation. Number, coordinates of redundant sliders on the guide rail; calculate the speed of moving platform; determine whether it is close to the dead point position; control the movement of each expansion bar group and redundant sliders to avoid the dead point position. The invention can predict and avoid dead points.

【技术实现步骤摘要】
一种冗余驱动并联机床死点规避系统及方法
本专利技术属于并联机床运动控制领域，特别是一种冗余驱动并联机床死点规避系统及方法。
技术介绍
自20世纪60年代提出Stewart机构以来，并联机构以其高精度、动态响应好、刚度重量比大等优点得到广泛的应用。并联机床作为并联机构和机床技术相结合的成果，是一种极具效率的现代划加工设备，所以对于应用于并联机床的并联机构的研究越来越重要。然而并联机构和传统机构一样存在死点位置且由于并联机构的运动较为复杂，各驱动杆相互配合，相互制约，在运动空间中更加难以准确预测和规避死点位置。而机构死点的存在对机构的正常运行存在很大影响，所以准确高效的预测死点位置，规避死点位置尤其重要。杜烨.含两个冗余驱动的C形龙门并联机床的数控研究[D].南京：南京理工大学，2017公开了一种C形龙门并联机床中并联机构的死点位置分析，但是并没有给出具体的死点监测及规避方法。
技术实现思路
本专利技术的目的在于提供一种冗余驱动并联机床死点规避系统及方法，以解决冗余驱动并联机床准确预测死点和规避死点的问题。实现本专利技术目的的技术解决方案为：一种冗余驱动并联机床死点规避系统，包括分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的伺服电机相连的三个测速发电机，分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的丝杠相连的三个电编码器，与冗余滑块相连的直线感应同步器，以及死点监测处理器；所述三个测速发电机分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速；所述三个光电编码器分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数；所述直线感应同步器用于采集冗余滑块在其导轨上的位置；所述死点监测处理器用于计算伸缩杆的速度和机构末端的速度的比值，并将比值与死点设定值进行比较，并判定并联机构是否接近死点位置，根据判定结果，控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。一种冗余驱动并联机床死点规避系统的方法，包括以下步骤：步骤1、获得上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速n1、n2、n3；上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数a1、a2、a3；冗余滑块在其导轨上的位置以确定冗余滑块在导轨上的坐标；步骤2、分别计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的伸缩速度v1、v2、v3；分别计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的的杆长l1、l2、l3；步骤3、计算动平台速度：已求得各伸缩杆速度v1、v2、v3和杆长l1、l2、l3，通过速度雅克比矩阵求出动平台运动速度vd；对不为零的伸缩杆速度和动平台速度求模即；步骤4、判定机构是否接近死点位置：计算动平台运动速度值和各伸缩杆的伸缩速度值的比值，将求得的比值与数据设定模块中的死点设定值S进行比较；若存在任意比值大于设定值，表示机构接近死点；比值若均不大于设定值，表示机构未接近死点；步骤5、控制各伸缩杆组及冗余滑块运动，规避死点位置。本专利技术与现有技术相比，其显著优点为：(1)本专利技术系统通过采集三个伸缩杆的电机的输出转速、丝杠转过的圈数、冗余滑块在其导轨上的位置，可判定出并联机构是否接近死点位置，根据判定结果可控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。(2)本专利技术所采用的死点接近判定方法间单快捷，计算速度较快，实时性好，能满足机床对实时性的高要求。(3)本专利技术所需数据容易采集，采集方式简单，且数据的处理易于实现，死点接近判定准确，能够完全规避死点位置。(4)本专利技术采用了用户输入死点设定值，用户可以根据并联机构结构参数和对死点接近程度不同的要求输入不同的死点设定值。附图说明图1是本专利技术冗余驱动并联机床死点规避系统及方法结构简图。图2是本专利技术驱动并联机床死点规避系统及方法流程图。图3是本专利技术冗余驱动并联机床中并联机构的机构简图。图4是本专利技术冗余驱动并联机床中并联机构简化后的机构简图。具体实施方式下面结合附图及具体实施例对本专利技术做进一步的介绍。结合图2，一种冗余驱动并联机床中并联机构，包括上伸缩杆组、下伸缩杆组、中间伸缩杆组、冗余滑块及导轨、四个伺服电机；所述上伸缩杆组一端采用球铰固定，另一端采用球铰与动平台上方相连；所述下伸缩杆组一端采用球铰固定，另一端采用球铰与动平台下方相连；所述中间伸缩杆组一端采用球铰与冗余滑块相连，另一端采用球铰与动平台后方相连；所述每个伸缩杆组与一个伺服电机相连，且伺服电机同步驱动两伸缩杆中的丝杠，使两伸缩杆做相同的伸缩运动；所述冗余滑块导轨固定，冗余滑块能在导轨上自由移动；所述冗余滑块采用伺服电机驱动；其中每个伸缩杆均由两根结构相同的伸缩杆组，且每个伸缩杆组中的两伸缩杆始终保证平行且杆长等长，故可把此并联结构简化为图4所示机构。结合图1，本专利技术的一种冗余驱动并联机床死点规避系统，包括分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的伺服电机相连的第一测速发电机1、第二测速发电机2、第三测速发电机3，分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的丝杠相连的第一光电编码器1、第二光电编码器2、第三光电编码器3，与冗余滑块相连的直线感应同步器，以及死点监测处理器。所述第一测速发电机1、第二测速发电机2、第三测速发电机3分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速n1、n2、n3；所述第一光电编码器1、第二光电编码器2、第三光电编码器3分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数a1、a2、a3；所述直线感应同步器用于采集冗余滑块在其导轨上的位置；所述死点监测处理器用于计算伸缩杆的速度和机构末端的速度的比值，并将比值与死点设定值进行比较，并判定并联机构是否接近死点位置，根据判定结果，控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。进一步的，所述死点监测处理器包括数据设定模块、数据采集模块、速度处理模块、死点接近判定模块、运动控制模块；所述数据设定模块用于设定死点设定值S；在并联机构死点附近计算并联机构各伸缩杆组的伸缩速度大小与并联机构的动平台速度大小的比值(可通过MATLAB仿真求得上述比值在三维空间内的分布图)。根据预期提前规避死点位置到死点的距离选择一个比值作为死点设定值。在死点接近判定时需要与此模块输入的设定值进行比较来确定是否接近死点。所述数据采集模块用于接收来自第一测速发电机1、第二测速发电机2、第三测速发电机3、第一光电编码器1、第二光电编码器2、第三光电编码器3和直线感应同步器的信号；以及接收来自直线感应同步器的信号确定冗余滑块的位置；所述速度处理模块用于根据测速发电机所测得各伸缩杆组中的伺服电机输出转速和各伸缩杆组中的传动比分别求得各伸缩杆的伸缩速度，以及根据光电编码器测得各伸缩杆组中的丝杠旋转的圈数和导程求得杆长；根据各伸缩杆的伸缩速度和杆长，得到动平台运动速度。所述死点接近判定模块用于计算动平台运动速度值和各伸缩杆的伸缩速度值的比值，将求得的比值与数据设定模块中的设定值进行比较，并判定机构是否接近死点。所述运动控制模块用于根据机构是否接近死点，控制三个伸缩杆组伸缩以及冗余滑块移动方向规避死点位置：若接近死点，则上下两个伸缩杆组固定不动，中间伸缩杆组可自由伸缩，冗余滑块根据当前所处的位置，沿滑轨正向或方向运动。若机构未接近死点本文档来自技高网...

【技术保护点】
1.一种冗余驱动并联机床死点规避系统，其特征在于，包括分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的伺服电机相连的三个测速发电机，分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的丝杠相连的三个电编码器，与冗余滑块相连的直线感应同步器，以及死点监测处理器；所述三个测速发电机分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速；所述三个光电编码器分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数；所述直线感应同步器用于采集冗余滑块在其导轨上的位置；所述死点监测处理器用于计算伸缩杆的速度和机构末端的速度的比值，并将比值与死点设定值进行比较，并判定并联机构是否接近死点位置，根据判定结果，控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。

【技术特征摘要】
1.一种冗余驱动并联机床死点规避系统，其特征在于，包括分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的伺服电机相连的三个测速发电机，分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的丝杠相连的三个电编码器，与冗余滑块相连的直线感应同步器，以及死点监测处理器；所述三个测速发电机分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速；所述三个光电编码器分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数；所述直线感应同步器用于采集冗余滑块在其导轨上的位置；所述死点监测处理器用于计算伸缩杆的速度和机构末端的速度的比值，并将比值与死点设定值进行比较，并判定并联机构是否接近死点位置，根据判定结果，控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。2.根据权利要求1所述的冗余驱动并联机床死点规避系统，其特征在于，所述死点监测处理器包括数据设定模块、数据采集模块、速度处理模块、死点接近判定模块、运动控制模块；所述数据设定模块用于设定死点设定值；所述数据采集模块用于接收三个编码器、三个光电传感器直线感应同步器的信号；所述速度处理模块用于根据测速发电机所测得各伸缩杆组中的伺服电机输出转速和各伸缩杆组中的传动比分别求得各伸缩杆的伸缩速度，以及根据光电编码器测得各伸缩杆组中的丝杠旋转的圈数和导程求得杆长；根据各伸缩杆的伸缩速度和杆长，得到动平台运动速度；所述死点接近判定模块用于计算动平台运动速度值和各伸缩杆的伸缩速度值的比值，将求得的比值与数据设定模块中的设定值进行比较，并判定机构是否接近死点；所述运动控制模块用于根据机构是否接近死点，控制三个伸缩杆组伸缩以及冗余滑块移动方向规避死点位置。3.根据权利要求2所述的冗余驱动并联机床死点规避系统，其特征在于，所述速度处理模块包括伸缩杆伸缩速度计算单元、伸缩杆杆长计算单元、动平台运动速度计算单元；所述伸缩杆伸缩速度计算单元根据测速发电机所测得各伸缩杆组中的伺服电机输出转速和各伸缩杆组中的传动比分别求得各伸缩杆的伸缩速度；所述伸缩杆杆长计算单元根据光电编码器测得各伸缩杆组中的丝杠旋转的圈数和导程求得杆长；所述动平台运动速度计算单元通过各伸缩杆速度和杆长，速度雅克比矩阵求出动平台运动速度；将各伸缩杆速度v1、v2、v3中为0的速度删除，对不为零的伸缩杆速度和动平台速度求模。4.根据权利要求2所述的冗余驱动并联机床死点规避系统，其特征在于，所述死点接近判定模块计算动平台运动速度值和各伸缩杆的伸缩速度值的比值的具体过...

【专利技术属性】
技术研发人员：李开明，葛帅帅，董立磊，舒阳，张阳，
申请(专利权)人：南京理工大学，
类型：发明
国别省市：江苏,32