[go: up one dir, main page]

CN109894906B - Redundant drive parallel machine tool dead point avoidance system and method - Google Patents

Redundant drive parallel machine tool dead point avoidance system and method Download PDF

Info

Publication number
CN109894906B
CN109894906B CN201910233271.4A CN201910233271A CN109894906B CN 109894906 B CN109894906 B CN 109894906B CN 201910233271 A CN201910233271 A CN 201910233271A CN 109894906 B CN109894906 B CN 109894906B
Authority
CN
China
Prior art keywords
telescopic rod
rod group
speed
dead point
redundant
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910233271.4A
Other languages
Chinese (zh)
Other versions
CN109894906A (en
Inventor
李开明
葛帅帅
董立磊
舒阳
张阳
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Science and Technology
Original Assignee
Nanjing University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing University of Science and Technology filed Critical Nanjing University of Science and Technology
Priority to CN201910233271.4A priority Critical patent/CN109894906B/en
Publication of CN109894906A publication Critical patent/CN109894906A/en
Application granted granted Critical
Publication of CN109894906B publication Critical patent/CN109894906B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Multiple Motors (AREA)
  • Numerical Control (AREA)

Abstract

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

Figure 201910233271

The invention discloses a system and method for avoiding dead point of a redundant drive parallel machine tool. The system comprises a tachometer generator and a photoelectric encoder connected with the servo motors of three retractable rod groups; a linear induction synchronizer connected with the redundant sliding block , and the dead point monitoring processor; the tachogenerator is used to collect the output speed of the servo motors of the three telescopic rod groups; the photoelectric encoder is used to collect the number of turns of the lead screws of the three telescopic rod groups; the linear induction synchronizer is used for The position of the redundant slider on its guide rail is collected; the dead point monitoring processor is used to determine whether the parallel mechanism is close to the dead point position, and controls the expansion and contraction of the three telescopic rod groups and the movement direction of the redundant slider to avoid the dead point position; the method includes obtaining The output speed of the three telescopic rod groups, the number of turns of the lead screw, the coordinates of the redundant slider on the guide rail; calculate the speed of the moving platform; determine whether it is close to the dead center position; control the movement of each telescopic rod group and the redundant slider Avoid dead spots. The present invention can predict dead spots and avoid dead spots.

Figure 201910233271

Description

一种冗余驱动并联机床死点规避系统及方法A system and method for avoiding dead point of redundant drive parallel machine tool

技术领域technical field

本发明属于并联机床运动控制领域,特别是一种冗余驱动并联机床死点规避系统及方法。The invention belongs to the field of parallel machine tool motion control, in particular to a system and method for avoiding dead point of a redundant drive parallel machine tool.

背景技术Background technique

自20世纪60年代提出Stewart机构以来,并联机构以其高精度、动态响应好、刚度重量比大等优点得到广泛的应用。并联机床作为并联机构和机床技术相结合的成果,是一种极具效率的现代划加工设备,所以对于应用于并联机床的并联机构的研究越来越重要。然而并联机构和传统机构一样存在死点位置且由于并联机构的运动较为复杂,各驱动杆相互配合,相互制约,在运动空间中更加难以准确预测和规避死点位置。而机构死点的存在对机构的正常运行存在很大影响,所以准确高效的预测死点位置,规避死点位置尤其重要。杜烨.含两个冗余驱动的C形龙门并联机床的数控研究[D].南京:南京理工大学,2017公开了一种C形龙门并联机床中并联机构的死点位置分析,但是并没有给出具体的死点监测及规避方法。Since the Stewart mechanism was proposed in the 1960s, the parallel mechanism has been widely used due to its high precision, good dynamic response, and large stiffness-to-weight ratio. As the result of the combination of parallel mechanism and machine tool technology, the parallel machine tool is a highly efficient modern cutting equipment, so the research on the parallel mechanism applied to the parallel machine tool is more and more important. However, the parallel mechanism has the same dead point position as the traditional mechanism, and due to the complex movement of the parallel mechanism, the driving rods cooperate with each other and restrict each other, so it is more difficult to accurately predict and avoid the dead point position in the motion space. The existence of the dead point of the mechanism has a great influence on the normal operation of the mechanism, so it is particularly important to accurately and efficiently predict the dead point position and avoid the dead point position. Du Ye. Numerical control research on a C-shaped gantry parallel machine tool with two redundant drives [D]. Nanjing: Nanjing University of Science and Technology, 2017 A dead-point analysis of the parallel mechanism in a C-shaped gantry parallel machine tool is disclosed, but there is no The specific dead point monitoring and avoidance methods are given.

发明内容SUMMARY OF THE INVENTION

本发明的目的在于提供一种冗余驱动并联机床死点规避系统及方法,以解决冗余驱动并联机床准确预测死点和规避死点的问题。The purpose of the present invention is to provide a system and method for avoiding the dead point of a redundant driving parallel machine tool, so as to solve the problem of accurately predicting and avoiding the dead point of the redundant driving parallel machine tool.

实现本发明目的的技术解决方案为:The technical solution that realizes the object of the present invention is:

一种冗余驱动并联机床死点规避系统,包括分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的伺服电机相连的三个测速发电机,分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的丝杠相连的三个电编码器,与冗余滑块相连的直线感应同步器,以及死点监测处理器;A redundant drive parallel machine tool dead point avoidance system, comprising three tachometer generators respectively connected with the servo motors of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group, respectively connected to the upper telescopic rod group and the middle telescopic rod group The three electric encoders connected with the lead screw of the lower telescopic rod group, the linear induction synchronizer connected with the redundant slider, and the dead point monitoring processor;

所述三个测速发电机分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速;所述三个光电编码器分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数;所述直线感应同步器用于采集冗余滑块在其导轨上的位置;所述死点监测处理器用于计算动平台的速度和伸缩杆组的速度的比值,并将比值与死点设定值进行比较,并判定并联机构是否接近死点位置,根据判定结果,控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。The three tachometer generators are respectively used to collect the output rotational speed of the servo motors in the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group; the three photoelectric encoders are used to collect the upper telescopic rod group, the middle The number of turns of the lead screw in the telescopic rod group and the lower telescopic rod group; 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 calculate the speed of the moving platform And the ratio of the speed of the telescopic rod group, and compare the ratio with the dead point setting value, and determine whether the parallel mechanism is close to the dead point position, according to the judgment result, control the expansion and contraction of the three telescopic rod groups and the movement direction of the redundant slider to Avoid dead spots.

一种冗余驱动并联机床死点规避系统的方法,包括以下步骤:A method for redundantly driving a dead point avoidance system of a parallel machine tool, comprising the following steps:

步骤1、获得上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速n1、n2、n3;上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数a1、a2、a3;冗余滑块在其导轨上的位置以确定冗余滑块在导轨上的坐标;Step 1. Obtain the output speeds n 1 , n 2 , n 3 of the servo motors in the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group; The number of turns a 1 , a 2 , a 3 of the lead screw; the position of the redundant slider on its guide rail to determine the coordinates of the redundant slider on the guide rail;

步骤2、分别计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的伸缩速度v1、v2、v3;分别计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的的杆长l1、l2、l3Step 2: Calculate the telescopic speeds v 1 , v 2 , v 3 of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group respectively; calculate the rods of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group respectively length l 1 , l 2 , l 3 ;

步骤3、计算动平台速度:已求得各伸缩杆速度v1、v2、v3和杆长l1、l2、l3,通过速度雅克比矩阵求出动平台运动速度vd;对不为零的伸缩杆速度和动平台速度求模即;Step 3. Calculate the speed of the moving platform: the speed v 1 , v 2 , v 3 and the lengths l 1 , l 2 , and l 3 of each telescopic rod have been obtained, and the moving speed v d of the moving platform is obtained through the speed Jacobian matrix; The non-zero telescopic rod speed and the moving platform speed are modulo;

步骤4、判定机构是否接近死点位置:计算动平台运动速度值和各伸缩杆的伸缩速度值的比值,将求得的比值与数据设定模块中的死点设定值S进行比较;若存在任意比值大于设定值,表示机构接近死点;比值若均不大于设定值,表示机构未接近死点;Step 4. Determine whether the mechanism is close to the dead center position: calculate the ratio between the moving speed value of the moving platform and the telescopic speed value of each telescopic rod, and compare the obtained ratio with the dead center setting value S in the data setting module; if If any ratio is greater than the set value, it means that the mechanism is close to the dead point; if the ratio is not greater than the set value, it means that the mechanism is not close to the dead point;

步骤5、控制各伸缩杆组及冗余滑块运动,规避死点位置。Step 5. Control the movement of each telescopic rod group and the redundant slider to avoid the dead center position.

本发明与现有技术相比,其显著优点为:Compared with the prior art, the present invention has the following significant advantages:

(1)本发明系统通过采集三个伸缩杆的电机的输出转速、丝杠转过的圈数、冗余滑块在其导轨上的位置,可判定出并联机构是否接近死点位置,根据判定结果可控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。(1) The system of the present invention can determine whether the parallel mechanism is close to the dead center position by collecting the output speed of the motors of the three telescopic rods, the number of turns of the lead screw, and the position of the redundant slider on its guide rail. As a result, the three telescopic rod groups can be controlled to extend and retract and the moving direction of the redundant slider to avoid the dead center position.

(2)本发明所采用的死点接近判定方法间单快捷,计算速度较快,实时性好,能满足机床对实时性的高要求。(2) The dead point approaching determination method adopted in the present invention is fast, fast in calculation speed, and good in real-time performance, which can meet the high requirements of machine tools for real-time performance.

(3)本发明所需数据容易采集,采集方式简单,且数据的处理易于实现,死点接近判定准确,能够完全规避死点位置。(3) The data required by the present invention is easy to collect, the collection method is simple, and the processing of the data is easy to realize, the determination of the proximity of the dead point is accurate, and the position of the dead point can be completely avoided.

(4)本发明采用了用户输入死点设定值,用户可以根据并联机构结构参数和对死点接近程度不同的要求输入不同的死点设定值。(4) The present invention adopts the user input dead point setting value, and the user can input different dead point setting values according to the structural parameters of the parallel mechanism and different requirements for the closeness of the dead point.

附图说明Description of drawings

图1是本发明冗余驱动并联机床死点规避系统及方法结构简图。FIG. 1 is a schematic structural diagram of the system and method for avoiding dead point of a redundant drive parallel machine tool according to the present invention.

图2是本发明驱动并联机床死点规避系统及方法流程图。FIG. 2 is a flow chart of the system and method for driving a parallel machine tool dead point avoidance according to the present invention.

图3是本发明冗余驱动并联机床中并联机构的机构简图。FIG. 3 is a schematic diagram of the parallel mechanism in the redundant drive parallel machine tool of the present invention.

图4是本发明冗余驱动并联机床中并联机构简化后的机构简图。FIG. 4 is a simplified mechanism diagram of the parallel mechanism in the redundant drive parallel machine tool of the present invention.

具体实施方式Detailed ways

下面结合附图及具体实施例对本发明做进一步的介绍。The present invention will be further introduced below with reference to the accompanying drawings and specific embodiments.

结合图2,一种冗余驱动并联机床中并联机构,包括上伸缩杆组、下伸缩杆组、中间伸缩杆组、冗余滑块及导轨、四个伺服电机;所述上伸缩杆组一端采用球铰固定,另一端采用球铰与动平台上方相连;所述下伸缩杆组一端采用球铰固定,另一端采用球铰与动平台下方相连;所述中间伸缩杆组一端采用球铰与冗余滑块相连,另一端采用球铰与动平台后方相连;所述每个伸缩杆组与一个伺服电机相连,且伺服电机同步驱动两伸缩杆中的丝杠,使两伸缩杆做相同的伸缩运动;所述冗余滑块导轨固定,冗余滑块能在导轨上自由移动;所述冗余滑块采用伺服电机驱动;其中每个伸缩杆均由两根结构相同的伸缩杆组,且每个伸缩杆组中的两伸缩杆始终保证平行且杆长等长,故可把此并联结构简化为图4所示机构。Referring to Figure 2, a parallel mechanism in a redundant drive parallel machine tool includes an upper telescopic rod group, a lower telescopic rod group, a middle telescopic rod group, redundant sliders and guide rails, and four servo motors; one end of the upper telescopic rod group is It is fixed by a ball hinge, and the other end is connected with the upper part of the moving platform by a ball hinge; one end of the lower telescopic rod group is fixed by a ball hinge, and the other end is connected with the bottom of the moving platform by a ball hinge; one end of the middle telescopic rod group is connected with a ball hinge at one end. The redundant sliders are connected, and the other end is connected with the back of the moving platform by a ball joint; each telescopic rod group is connected with a servo motor, and the servo motor drives the lead screws in the two telescopic rods synchronously, so that the two telescopic rods do the same Telescopic movement; the redundant slider guide is fixed, and the redundant slider can move freely on the guide rail; the redundant slider is driven by a servo motor; each telescopic rod is composed of two telescopic rod groups with the same structure, In addition, the two telescopic rods in each telescopic rod group are always guaranteed to be parallel and of equal length, so the parallel structure can be simplified as the mechanism shown in FIG. 4 .

结合图1,本发明的一种冗余驱动并联机床死点规避系统,包括分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的伺服电机相连的第一测速发电机1、第二测速发电机2、第三测速发电机3,分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的丝杠相连的第一光电编码器11、第二光电编码器12、第三光电编码器13,与冗余滑块相连的直线感应同步器,以及死点监测处理器。1, a redundant drive parallel machine tool dead center avoidance system of the present invention includes a first tachometer generator 1, a second tachometer connected to the servo motors of the upper telescopic rod group, the middle telescopic rod group, and the lower telescopic rod group, respectively. The tachogenerator 2, the third tachogenerator 3, the first photoelectric encoder 11, the second photoelectric encoder 12, the third photoelectric encoder 11, the second photoelectric encoder 12, the third photoelectric Encoder 13, linear inductive synchronizer connected to redundant sliders, and dead center monitoring processor.

所述第一测速发电机1、第二测速发电机2、第三测速发电机3分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速n1、n2、n3;所述第一光电编码器11、第二光电编码器12、第三光电编码器13分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数a1、a2、a3;所述直线感应同步器用于采集冗余滑块在其导轨上的位置;所述死点监测处理器用于计算动平台的速度和三个伸缩杆组的速度的比值,并将比值与死点设定值进行比较,并判定并联机构是否接近死点位置,根据判定结果,控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。The first tachogenerator 1, the second tachogenerator 2, and the third tachogenerator 3 are respectively used to collect the output rotational speed n 1 , n 2 , n 3 ; the first photoelectric encoder 11 , the second photoelectric encoder 12 and the third photoelectric encoder 13 are respectively used to collect the lead screws in the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group The number of turns a 1 , a 2 , a 3 turned; 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 calculate the speed of the moving platform and the three telescopic The ratio of the speed of the rod group, and compare the ratio with the dead point setting value, and determine whether the parallel mechanism is close to the dead point position. point location.

进一步的,所述死点监测处理器包括数据设定模块、数据采集模块、速度处理模块、死点接近判定模块、运动控制模块;Further, the dead point monitoring processor includes a data setting module, a data acquisition module, a speed processing module, a dead point proximity determination module, and a motion control module;

所述数据设定模块用于设定死点设定值S;在并联机构死点附近计算并联机构各伸缩杆组的伸缩速度大小与并联机构的动平台速度大小的比值(可通过MATLAB仿真求得上述比值在三维空间内的分布图)。根据预期提前规避死点位置到死点的距离选择一个比值作为死点设定值。在死点接近判定时需要与此模块输入的设定值进行比较来确定是否接近死点。The data setting module is used to set the dead point setting value S; the ratio of the telescopic speed of each telescopic rod group of the parallel mechanism to the speed of the moving platform of the parallel mechanism is calculated near the dead point of the parallel mechanism (which can be obtained by MATLAB simulation. to obtain the distribution map of the above ratios in three-dimensional space). Select a ratio as the dead point setting value according to the distance from the dead point position to the dead point that is expected to be avoided in advance. When the dead point is close to the judgment, it needs to compare with the set value input by this module to determine whether it is close to the dead point.

所述数据采集模块用于接收来自第一测速发电机1、第二测速发电机2、第三测速发电机3、第一光电编码器11、第二光电编码器12、第三光电编码器13和直线感应同步器的信号;以及接收来自直线感应同步器的信号确定冗余滑块的位置;The data acquisition module is used to receive data from the first tachogenerator 1 , the second tachogenerator 2 , the third tachogenerator 3 , the first photoelectric encoder 11 , the second photoelectric encoder 12 , and the third photoelectric encoder 13 and the signal from the linear induction synchronizer; and receiving the signal from the linear induction synchronizer to determine the position of the redundant slider;

所述速度处理模块用于根据测速发电机所测得各伸缩杆组中的伺服电机输出转速和各伸缩杆组中的传动比分别求得各伸缩杆组的伸缩速度,以及根据光电编码器测得各伸缩杆组中的丝杠旋转的圈数和导程求得杆长;根据各伸缩杆组的伸缩速度和杆长,得到动平台运动速度。The speed processing module is used to obtain the telescopic speed of each telescopic rod group according to the output speed of the servo motor in each telescopic rod group measured by the tachogenerator and the transmission ratio in each telescopic rod group, and to measure the telescopic speed of each telescopic rod group according to the photoelectric encoder. The number of turns and the lead of the lead screw in each telescopic rod group can be obtained to obtain the rod length; according to the telescopic speed and rod length of each telescopic rod group, the moving speed of the moving platform can be obtained.

所述死点接近判定模块用于计算动平台运动速度值和各伸缩杆组的伸缩速度值的比值,将求得的比值与数据设定模块中的设定值进行比较,并判定机构是否接近死点。The dead point proximity determination module is used to calculate the ratio between the moving speed value of the moving platform and the telescopic speed value of each telescopic rod group, compare the obtained ratio with the set value in the data setting module, and determine whether the mechanism is close to dead point.

所述运动控制模块用于根据机构是否接近死点,控制三个伸缩杆组伸缩以及冗余滑块移动方向规避死点位置:若接近死点,则上下两个伸缩杆组固定不动,中间伸缩杆组可自由伸缩,冗余滑块根据当前所处的位置,沿滑轨正向或方向运动。若机构未接近死点,冗余滑块不运动,重新进行数据采集并计算判定机构是否接近死点。The motion control module is used to control the expansion and contraction of the three telescopic rod groups and the movement direction of the redundant sliders to avoid the dead point position according to whether the mechanism is close to the dead point: if it is close to the dead point, the upper and lower two telescopic rod groups are fixed, and the middle The telescopic rod group can be freely retracted, and the redundant sliding block moves in the forward or direction of the sliding rail according to the current position. If the mechanism is not close to the dead point, the redundant slider does not move, and the data acquisition is performed again and the calculation is performed to determine whether the mechanism is close to the dead point.

进一步的,所述速度处理模块包括伸缩杆伸缩速度计算单元、伸缩杆杆长计算单元、动平台运动速度计算单元;Further, the speed processing module includes a telescopic rod telescopic speed calculation unit, a telescopic rod rod length calculation unit, and a moving platform motion speed calculation unit;

所述伸缩杆伸缩速度计算单元根据测速发电机所测得各伸缩杆组中的伺服电机输出转速和各伸缩杆组中的传动比分别求得各伸缩杆组的伸缩速度;The telescopic rod telescopic speed calculation unit obtains the telescopic speed of each telescopic rod group respectively according to the output speed of the servo motor in each telescopic rod group and the transmission ratio in each telescopic rod group measured by the tachometer generator;

设三个伸缩杆组中伺服电机转速和伸缩杆伸缩速度的传动比分别为i1、i2、i3Assume that the transmission ratios of the servo motor speed and the telescopic speed of the telescopic rods in the three telescopic rod groups are i 1 , i 2 , and i 3 , respectively,

则上伸缩杆组的伸缩速度为:v1=n1·i1Then the telescopic speed of the upper telescopic rod group is: v 1 =n 1 ·i 1 ;

中间伸缩杆组的伸缩速度为:v2=n2·i2The telescopic speed of the middle telescopic rod group is: v 2 =n 2 ·i 2 ;

下伸缩杆组的伸缩速度为:v3=n3·i3The telescopic speed of the lower telescopic rod group is: v 3 =n 3 ·i 3 ;

所述伸缩杆杆长计算单元根据光电编码器测得各伸缩杆组中的丝杠旋转的圈数和导程求得杆长;The rod length calculation unit of the telescopic rod obtains the rod length according to the number of turns and the lead of the rotation of the lead screw in each telescopic rod group measured by the photoelectric encoder;

设三个伸缩杆组中的丝杠导程分别为L1、L2、L3Let the lead screw leads in the three telescopic rod groups be L 1 , L 2 , and L 3 respectively;

则上伸缩杆组的杆长为:l1=a1·L1Then the rod length of the upper telescopic rod group is: l 1 =a 1 ·L 1 ;

中间伸缩杆组的杆长为:l2=a2·L2The rod length of the middle telescopic rod group is: l 2 =a 2 ·L 2 ;

下伸缩杆组的杆长为:l3=a3·L3The rod length of the lower telescopic rod group is: l 3 =a 3 ·L 3 ;

所述动平台运动速度计算单元通过各伸缩杆组速度v1、v2、v3和杆长l1、l2、l3,再通过速度雅克比矩阵求出动平台运动速度vd。将各伸缩杆组速度v1、v2、v3中为0的速度删除,对不为零的伸缩杆组速度和动平台速度求模即为|v1|、|v2|、|v3|、|vd|,设伸缩杆组速度均不为0。The moving platform moving speed calculation unit calculates the moving platform moving speed v d through the speed of each telescopic rod group v 1 , v 2 , v 3 and the rod lengths l 1 , l 2 , l 3 , and then through the velocity Jacobian matrix. Delete the velocities that are 0 in the velocities v 1 , v 2 , and v 3 of each telescopic rod group, and calculate the modulo of the non-zero telescopic rod group velocities and the moving platform velocities, namely |v 1 |, |v 2 |, |v 3 |, |v d |, let the speed of the telescopic rod group not be 0.

进一步的,所述死点接近判定模块计算动平台运动速度值和各伸缩杆组的伸缩速度值的比值的具体过程为:Further, the specific process of calculating the ratio of the moving speed value of the moving platform to the telescopic speed value of each telescopic rod group by the dead point proximity determination module is as follows:

设冗余滑块沿导轨的滑动方向为X轴,冗余滑块位于导轨的正中间位置的x坐标为0,根据冗余滑块在导轨上的位置,确定其在机床坐标中的x坐标为xsLet the sliding direction of the redundant slider along the guide rail be the X axis, and the x coordinate of the redundant slider at the middle position of the guide rail is 0. According to the position of the redundant slider on the guide rail, determine its x coordinate in the machine tool coordinates. is x s .

死点接近判定模块计算动平台运动速度值和各伸缩杆组的伸缩速度值的比值,将求得的比值与数据设定模块中的死点设定值S进行比较。若存在任意比值大于设定值,表示机构接近死点;比值若均不大于设定值,表示机构未接近死点。即:The dead point approach determination module calculates the ratio of the moving speed value of the moving platform and the telescopic speed value of each telescopic rod group, and compares the obtained ratio with the dead point setting value S in the data setting module. If there is any ratio greater than the set value, it means that the mechanism is close to the dead point; if the ratio is not greater than the set value, it means that the mechanism is not close to the dead point. which is:

Figure GDA0002676997820000051
机构未接近死点;否则,机构接近死点。like
Figure GDA0002676997820000051
The mechanism is not near dead center; otherwise, the mechanism is near dead center.

所述运动控制模块根据上述判定结果,若机构接近死点,根据冗余滑块当前的位置决定控制冗余滑块伺服电机如何运动,然后控制上下伸缩杆组伺服电机锁死,中间伸缩杆组可自由伸缩;若冗余滑块在X轴坐标xs小于零(坐标xs<0),则发信号给伺服电机,使其控制冗余滑块向X轴正方向移动;反之(坐标xs≥0),发信号给伺服电机,使其控制冗余滑块向X轴负方向移动。According to the above judgment result, if the mechanism is close to the dead point, the motion control module determines how to control the servo motor of the redundant slider according to the current position of the redundant slider, and then controls the servo motor of the upper and lower telescopic rod groups to be locked, and the middle telescopic rod group is locked. It can be freely stretched; if the redundant slider at the X-axis coordinate x s is less than zero (coordinate x s < 0), it will send a signal to the servo motor to control the redundant slider to move in the positive direction of the X-axis; otherwise (coordinate x s ≥ 0), send a signal to the servo motor to control the redundant slider to move in the negative direction of the X axis.

一种冗余驱动并联机床死点规避系统的方法,包括以下步骤:A method for redundantly driving a dead point avoidance system of a parallel machine tool, comprising the following steps:

步骤1、输入死点设定值S,可根据对死点接近程度的不同要求输入不同的设定值用于规避死点位置;Step 1. Input the dead point setting value S, which can be used to avoid the dead point position according to the different requirements for the proximity of the dead point;

步骤2、获得上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速n1、n2、n3;上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数a1、a2、a3;冗余滑块在其导轨上的位置以确定冗余滑块在导轨上的坐标;Step 2, obtain the output speeds n 1 , n 2 , n 3 of the servo motors in the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group; The number of turns a 1 , a 2 , a 3 of the lead screw; the position of the redundant slider on its guide rail to determine the coordinates of the redundant slider on the guide rail;

步骤3、分别计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的伸缩速度v1、v2、v3;分别计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的杆长l1、l2、l3Step 3. Calculate the telescopic speeds v 1 , v 2 , v 3 of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group respectively; calculate the rod lengths of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group respectively l 1 , l 2 , l 3 ;

根据测速发电机所测得各伸缩杆组中的伺服电机输出转速和各伸缩杆组中的传动比分别求得各伸缩杆组的伸缩速度;根据光电编码器测得各伸缩杆组中的丝杠旋转的圈数和导程求得杆长;According to the output speed of the servo motor in each telescopic rod group measured by the tachogenerator and the transmission ratio in each telescopic rod group, the telescopic speed of each telescopic rod group is obtained respectively; the wire in each telescopic rod group is measured according to the photoelectric encoder. The number of turns and the lead of the bar rotation are used to obtain the bar length;

3.1、计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的伸缩速度v1、v2、v3:上伸缩杆组的伸缩速度为v1=n1·i1,中间伸缩杆组的伸缩速度为v2=n2·i2,下伸缩杆组的伸缩速度为v3=n3·i33.1. Calculate the telescopic speed v 1 , v 2 , v 3 of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group: the telescopic speed of the upper telescopic rod group is v 1 =n 1 ·i 1 , the middle telescopic rod group The telescopic speed of the lower telescopic rod group is v 2 =n 2 ·i 2 , and the telescopic speed of the lower telescopic rod group is v 3 =n 3 ·i 3 .

3.2、计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的的杆长l1、l2、l3:上伸缩杆组的杆长为l1=a1·L1,中间伸缩杆组的杆长为l2=a2·L2,下伸缩杆组的杆长为l3=a3·L33.2. Calculate the rod lengths l 1 , l 2 and l 3 of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group: the rod length of the upper telescopic rod group is l 1 =a 1 ·L 1 , the middle telescopic rod The rod length of the group is l 2 =a 2 ·L 2 , and the rod length of the lower telescopic rod group is l 3 =a 3 ·L 3 .

步骤4、计算动平台速度:已求得各伸缩杆组速度v1、v2、v3和杆长l1、l2、l3,通过速度雅克比矩阵求出动平台运动速度vdStep 4. Calculate the velocity of the moving platform: The velocity v 1 , v 2 , v 3 and the lengths l 1 , l 2 , and l 3 of each telescopic rod group have been obtained, and the moving velocity v d of the moving platform is obtained through the velocity Jacobian matrix.

将各伸缩杆组速度v1、v2、v3中为0的速度删除,对不为零的伸缩杆组速度和动平台速度求模即为|v1|、|v2|、|v3|、|vd|,设伸缩杆组速度均不为0。Delete the velocities that are 0 in the velocities v 1 , v 2 , and v 3 of each telescopic rod group, and calculate the modulo of the non-zero telescopic rod group velocities and the moving platform velocities, namely |v 1 |, |v 2 |, |v 3 |, |v d |, let the speed of the telescopic rod group not be 0.

步骤5、判定机构是否接近死点位置:计算动平台运动速度值和各伸缩杆组的伸缩速度值的比值,将求得的比值与数据设定模块中的死点设定值S进行比较;若存在任意比值大于设定值,表示机构接近死点;比值若均不大于设定值,表示机构未接近死点。Step 5, determine whether the mechanism is close to the dead center position: calculate the ratio of the moving speed value of the moving platform and the telescopic speed value of each telescopic rod group, and compare the obtained ratio with the dead point setting value S in the data setting module; If there is any ratio greater than the set value, it means that the mechanism is close to the dead point; if the ratio is not greater than the set value, it means that the mechanism is not close to the dead point.

即:which is:

Figure GDA0002676997820000061
机构未接近死点;否则,机构接近死点。like
Figure GDA0002676997820000061
The mechanism is not near dead center; otherwise, the mechanism is near dead center.

步骤6、控制各伸缩杆组及冗余滑块运动,规避死点位置:Step 6. Control the movement of each telescopic rod group and the redundant slider to avoid the dead point position:

若机构接近死点,根据冗余滑块当前的位置决定控制冗余滑块伺服电机如何运动,然后控制上下伸缩杆组伺服电机锁死,中间伸缩杆组可自由伸缩;若冗余滑块在X轴坐标中坐标xs小于零,则发信号给伺服电机,使其控制冗余滑块向X轴正方向移动;反之,发信号给伺服电机,使其控制冗余滑块向X轴负方向移动。If the mechanism is close to the dead center, according to the current position of the redundant slider, determine how to control the servo motor of the redundant slider, and then control the servo motor of the upper and lower telescopic rod groups to lock, and the middle telescopic rod group can be freely retracted; if the redundant slider is in If the coordinate x s in the X-axis coordinate is less than zero, send a signal to the servo motor to control the redundant slider to move in the positive direction of the X-axis; otherwise, send a signal to the servo motor to control the redundant slider to move in the negative direction of the X-axis direction move.

其中,冗余滑块沿导轨的滑动方向为X轴,冗余滑块位于导轨的正中间位置的x坐标为0,根据冗余滑块在导轨上的位置,确定其在机床坐标中的x坐标为xsAmong them, the sliding direction of the redundant slider along the guide rail is the X axis, and the x coordinate of the redundant slider at the middle position of the guide rail is 0. According to the position of the redundant slider on the guide rail, determine its x coordinate in the machine tool coordinate The coordinates are x s .

本发明的联结构简化为图4,根据此并联机床并联机构的机构原理,上下两根伸缩杆的杆长均为确定值时,此时上下支链可确定一个圆,中间支链与圆周的交点即为该机构末端的位置。如果中间支链与两支链固定位置的连线(C1C2线)相交,此时传动角为零,机构到达死点位置。根据机构位置关系可知,在上、下伸缩杆组杆长确定的情况下,中间伸缩杆组的杆长增量,与末端移动距离是非线性关系,在中间伸缩杆组杆长相同的增量下,越接近死点位置时,末端运动距离越大。故本发明只需实时测量伸缩杆组的速度和机构末端的速度,根据两者之间的比值与设定值比较即可确定此种并联机构是否接近死点位置。The link structure of the present invention is simplified as Fig. 4. According to the mechanism principle of the parallel mechanism of the parallel machine tool, when the rod lengths of the upper and lower telescopic rods are both fixed values, the upper and lower branch chains can determine a circle, and the middle branch chain and the circumference The intersection is the location of the end of the mechanism. If the middle branch chain intersects with the line connecting the fixed positions of the two branch chains (C 1 C 2 line), the transmission angle is zero at this time, and the mechanism reaches the dead center position. According to the positional relationship of the mechanism, when the rod lengths of the upper and lower telescopic rod groups are determined, the increment of the rod length of the middle telescopic rod group has a nonlinear relationship with the moving distance of the end. Under the same increment of the rod length of the middle telescopic rod group , the closer to the dead center position, the greater the end movement distance. Therefore, the present invention only needs to measure the speed of the telescopic rod group and the speed of the end of the mechanism in real time, and determine whether the parallel mechanism is close to the dead center position by comparing the ratio between the two with the set value.

本发明所需采集的数据都比较容易采集,采集方式较简单可靠;在数据处理上,算法简单容易实现且判定结果可靠;死点接近判定所需数据也较少且计算简单,所以计算速度快,反应灵敏,能够满足机床对实时性的高要求;还采用了数据设定模块,用户可以根据所研究的并联机构结构参数和对死点接近程度的要求输入不同的死点设定值,使并联机构提前规避死点。The data to be collected in the present invention is relatively easy to collect, and the collection method is simple and reliable; in data processing, the algorithm is simple and easy to implement and the judgment result is reliable; the data required for the close-to-dead-point judgment is also less and the calculation is simple, so the calculation speed is fast , the response is sensitive, which can meet the high requirements of the machine tool for real-time performance; it also adopts a data setting module, and the user can input different dead point setting values according to the structural parameters of the parallel mechanism under study and the requirements for the proximity of the dead point, so that the The parallel mechanism avoids the dead point in advance.

Claims (8)

1.一种冗余驱动并联机床死点规避系统,其特征在于,包括分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的伺服电机相连的三个测速发电机,分别与上伸缩杆组、中间伸缩杆组、下伸缩杆组的丝杠相连的三个光电编码器,与冗余滑块相连的直线感应同步器,以及死点监测处理器;1. a redundant drive parallel machine tool dead point avoidance system, is characterized in that, comprises three tachometer generators that are connected with the servo motors of the upper telescopic rod group, the middle telescopic rod group, the lower telescopic rod group, respectively, and the upper telescopic rod group respectively. Three photoelectric encoders connected with the lead screw of the rod group, the middle telescopic rod group and the lower telescopic rod group, the linear induction synchronizer connected with the redundant slider, and the dead point monitoring processor; 所述三个测速发电机分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速;所述三个光电编码器分别用于采集上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数;所述直线感应同步器用于采集冗余滑块在其导轨上的位置;所述死点监测处理器用于计算动平台的速度和三个伸缩杆组的速度的比值,并将比值与死点设定值进行比较,并判定并联机构是否接近死点位置,根据判定结果,控制三个伸缩杆组伸缩以及冗余滑块移动方向以规避死点位置。The three tachometer generators are respectively used to collect the output rotational speed of the servo motors in the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group; the three photoelectric encoders are used to collect the upper telescopic rod group, the middle The number of turns of the lead screw in the telescopic rod group and the lower telescopic rod group; 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 calculate the speed of the moving platform and the ratio of the speed of the three telescopic rod groups, and compare the ratio with the dead point set value, and determine whether the parallel mechanism is close to the dead point position, and control the expansion and contraction of the three telescopic rod groups and the movement of the redundant slider according to the judgment result. direction to avoid the dead center position. 2.根据权利要求1所述的冗余驱动并联机床死点规避系统,其特征在于,所述死点监测处理器包括数据设定模块、数据采集模块、速度处理模块、死点接近判定模块、运动控制模块;2. The redundant drive parallel machine tool dead point avoidance system according to claim 1, wherein the dead point monitoring processor comprises a data setting module, a data acquisition module, a speed processing module, a dead point approaching judgment module, motion control module; 所述数据设定模块用于设定死点设定值;The data setting module is used to set the dead point setting value; 所述数据采集模块用于接收三个编码器、三个光电传感器直线感应同步器的信号;The data acquisition module is used for receiving signals from three encoders and three photoelectric sensors linear induction synchronizers; 所述速度处理模块用于根据测速发电机所测得各伸缩杆组中的伺服电机输出转速和各伸缩杆组中的传动比分别求得各伸缩杆组的伸缩速度,以及根据光电编码器测得各伸缩杆组中的丝杠旋转的圈数和导程求得杆长;根据各伸缩杆组的伸缩速度和杆长,得到动平台运动速度;The speed processing module is used to obtain the telescopic speed of each telescopic rod group according to the output speed of the servo motor in each telescopic rod group measured by the tachogenerator and the transmission ratio in each telescopic rod group, and to measure the telescopic speed of each telescopic rod group according to the photoelectric encoder. The number of turns and the lead of the lead screw in each telescopic rod group can be obtained to obtain the rod length; according to the telescopic speed and rod length of each telescopic rod group, the moving speed of the moving platform can be obtained; 所述死点接近判定模块用于计算动平台运动速度值和各伸缩杆组的伸缩速度值的比值,将求得的比值与数据设定模块中的设定值进行比较,并判定机构是否接近死点;The dead point proximity determination module is used to calculate the ratio between the moving speed value of the moving platform and the telescopic speed value of each telescopic rod group, compare the obtained ratio with the set value in the data setting module, and determine whether the mechanism is close to dead point; 所述运动控制模块用于根据机构是否接近死点,控制三个伸缩杆组伸缩以及冗余滑块移动方向规避死点位置。The motion control module is used to control the expansion and contraction of the three telescopic rod groups and the movement direction of the redundant slider to avoid the dead point position according to whether the mechanism is close to the dead point. 3.根据权利要求2所述的冗余驱动并联机床死点规避系统,其特征在于,所述速度处理模块包括伸缩杆伸缩速度计算单元、伸缩杆杆长计算单元、动平台运动速度计算单元;3. The redundant drive parallel machine tool dead center avoidance system according to claim 2, wherein the speed processing module comprises a telescopic rod telescopic speed calculation unit, a telescopic rod rod length calculation unit, and a moving platform motion speed calculation unit; 所述伸缩杆伸缩速度计算单元根据测速发电机所测得各伸缩杆组中的伺服电机输出转速和各伸缩杆组中的传动比分别求得各伸缩杆组的伸缩速度;The telescopic rod telescopic speed calculation unit obtains the telescopic speed of each telescopic rod group respectively according to the output speed of the servo motor in each telescopic rod group and the transmission ratio in each telescopic rod group measured by the tachometer generator; 所述伸缩杆杆长计算单元根据光电编码器测得各伸缩杆组中的丝杠旋转的圈数和导程求得杆长;The rod length calculation unit of the telescopic rod obtains the rod length according to the number of turns and the lead of the rotation of the lead screw in each telescopic rod group measured by the photoelectric encoder; 所述动平台运动速度计算单元通过各伸缩杆组速度和杆长,速度雅克比矩阵求出动平台运动速度;将各伸缩杆组速度v1、v2、v3中为0的速度删除,对不为零的伸缩杆组速度和动平台速度求模。 The moving platform movement speed calculation unit obtains the moving platform movement speed through the speed of each telescopic rod group, the rod length, and the speed Jacobian matrix ; Modulo the non-zero telescopic rod group velocity and the moving platform velocity. 4.根据权利要求2所述的冗余驱动并联机床死点规避系统,其特征在于,所述死点接近判定模块计算动平台运动速度值和各伸缩杆组的伸缩速度值的比值的具体过程为:4. The redundant drive parallel machine tool dead point avoidance system according to claim 2, wherein the dead point approach determination module calculates the specific process of the ratio of the moving platform movement speed value and the telescopic speed value of each telescopic rod group for: 计算动平台运动速度值和各伸缩杆组的伸缩速度值的比值,将求得的比值与数据设定模块中的死点设定值S进行比较;若存在任意比值大于设定值,表示机构接近死点;比值若均不大于设定值,表示机构未接近死点。Calculate the ratio between the moving speed value of the moving platform and the telescopic speed value of each telescopic rod group, and compare the obtained ratio with the dead point set value S in the data setting module; if there is any ratio greater than the set value, it means that the mechanism Close to the dead point; if the ratio is not greater than the set value, it means that the mechanism is not close to the dead point. 5.根据权利要求4所述的冗余驱动并联机床死点规避系统,其特征在于,所述运动控制模块根据判定结果,若机构接近死点,控制上、下伸缩杆组伺服电机锁死,中间伸缩杆组可自由伸缩:5. The redundant drive parallel machine tool dead center avoidance system according to claim 4, wherein the motion control module controls the upper and lower telescopic rod sets to lock the servo motors according to the judgment result, if the mechanism is close to the dead center, The middle telescopic rod group can be freely retracted: 若冗余滑块在X轴坐标小于零,控制冗余滑块向X轴正方向移动;If the coordinate of the redundant slider on the X axis is less than zero, control the redundant slider to move in the positive direction of the X axis; 反之,控制冗余滑块向X轴负方向移动。Conversely, control the redundant slider to move in the negative direction of the X axis. 6.一种冗余驱动并联机床死点规避系统的方法,其特征在于,包括以下步骤:6. A method for redundantly driving a parallel machine tool dead point avoidance system, characterized in that it comprises the following steps: 步骤1、获得上伸缩杆组、中间伸缩杆组和下伸缩杆组中的伺服电机的输出转速n1、n2、n3;上伸缩杆组、中间伸缩杆组和下伸缩杆组中的丝杠转过的圈数a1、a2、a3;冗余滑块在其导轨上的位置以确定冗余滑块在导轨上的坐标;Step 1. Obtain the output speeds n 1 , n 2 , n 3 of the servo motors in the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group; The number of turns a 1 , a 2 , a 3 of the lead screw; the position of the redundant slider on its guide rail to determine the coordinates of the redundant slider on the guide rail; 步骤2、分别计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的伸缩速度v1、v2、v3;分别计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的的杆长l1、l2、l3Step 2: Calculate the telescopic speeds v 1 , v 2 , v 3 of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group respectively; calculate the rods of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group respectively length l 1 , l 2 , l 3 ; 步骤3、计算动平台速度:已求得各伸缩杆组速度v1、v2、v3和杆长l1、l2、l3,通过速度雅克比矩阵求出动平台运动速度vd;对不为零的伸缩杆组速度和动平台速度求模;Step 3. Calculate the speed of the moving platform: the speeds v 1 , v 2 , v 3 and the lengths l 1 , l 2 , and l 3 of each telescopic rod group have been obtained, and the moving speed v d of the moving platform is obtained through the velocity Jacobian matrix; Calculate the modulo of the non-zero telescopic rod group speed and the moving platform speed; 步骤4、判定机构是否接近死点位置:计算动平台运动速度值和各伸缩杆组的伸缩速度值的比值,将求得的比值与数据设定模块中的死点设定值S进行比较;若存在任意比值大于设定值,表示机构接近死点;比值若均不大于设定值,表示机构未接近死点;Step 4, determine whether the mechanism is close to the dead point position: calculate the ratio of the moving speed value of the moving platform and the telescopic speed value of each telescopic rod group, and compare the obtained ratio with the dead point setting value S in the data setting module; If there is any ratio greater than the set value, it means that the mechanism is close to the dead point; if the ratio is not greater than the set value, it means that the mechanism is not close to the dead point; 步骤5、控制各伸缩杆组及冗余滑块运动,规避死点位置。Step 5. Control the movement of each telescopic rod group and the redundant slider to avoid the dead center position. 7.根据权利要求6所述的冗余驱动并联机床死点规避系统的方法,其特征在于,步骤2计算伸缩杆组速度、杆长,具体包括以下步骤:7. The method for redundantly driving a parallel machine tool dead center avoidance system according to claim 6, wherein step 2 calculates the speed of the telescopic rod group and the rod length, and specifically comprises the following steps: 2.1、计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的伸缩速度v1、v2、v3:上伸缩杆组的伸缩速度为v1=n1·i1,中间伸缩杆组的伸缩速度为v2=n2·i2,下伸缩杆组的伸缩速度为v3=n3·i32.1. Calculate the telescopic speed v 1 , v 2 , v 3 of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group: the telescopic speed of the upper telescopic rod group is v 1 =n 1 ·i 1 , the middle telescopic rod group The telescopic speed of the lower telescopic rod group is v 2 =n 2 ·i 2 , and the telescopic speed of the lower telescopic rod group is v 3 =n 3 ·i 3 ; 2.2、计算上伸缩杆组、中间伸缩杆组和下伸缩杆组的的杆长l1、l2、l3:上伸缩杆组的杆长为l1=a1·L1,中间伸缩杆组的杆长为l2=a2·L2,下伸缩杆组的杆长为l3=a3·L32.2. Calculate the rod lengths l 1 , l 2 , l 3 of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group: the rod length of the upper telescopic rod group is l 1 = a 1 · L 1 , the middle telescopic rod The rod length of the group is l 2 =a 2 ·L 2 , and the rod length of the lower telescopic rod group is l 3 =a 3 ·L 3 ; 其中i1、i2、i3分别为上伸缩杆组、中间伸缩杆组和下伸缩杆组的传动比;L1、L2、L3分别为上伸缩杆组、中间伸缩杆组和下伸缩杆组的丝杠导程。Wherein i 1 , i 2 , i 3 are the transmission ratios of the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group, respectively; L 1 , L 2 , L 3 are the upper telescopic rod group, the middle telescopic rod group and the lower telescopic rod group, respectively; The lead screw of the telescopic rod set. 8.根据权利要求6所述的冗余驱动并联机床死点规避系统的方法,其特征在于,步骤5规避死点方法为:8. The method for redundant drive parallel machine tool dead point avoidance system according to claim 6, characterized in that, the step 5 method for avoiding dead point is: 若机构接近死点,控制上下伸缩杆组伺服电机锁死,中间伸缩杆组可自由伸缩:If the mechanism is close to the dead center, the servo motors of the upper and lower telescopic rod groups are controlled to be locked, and the middle telescopic rod group can be freely retracted: 若冗余滑块在X轴坐标小于零,控制冗余滑块向X轴正方向移动;If the coordinate of the redundant slider on the X axis is less than zero, control the redundant slider to move in the positive direction of the X axis; 反之,控制冗余滑块向X轴负方向移动。Conversely, control the redundant slider to move in the negative direction of the X axis.
CN201910233271.4A 2019-03-26 2019-03-26 Redundant drive parallel machine tool dead point avoidance system and method Active CN109894906B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910233271.4A CN109894906B (en) 2019-03-26 2019-03-26 Redundant drive parallel machine tool dead point avoidance system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910233271.4A CN109894906B (en) 2019-03-26 2019-03-26 Redundant drive parallel machine tool dead point avoidance system and method

Publications (2)

Publication Number Publication Date
CN109894906A CN109894906A (en) 2019-06-18
CN109894906B true CN109894906B (en) 2020-11-06

Family

ID=66952533

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910233271.4A Active CN109894906B (en) 2019-03-26 2019-03-26 Redundant drive parallel machine tool dead point avoidance system and method

Country Status (1)

Country Link
CN (1) CN109894906B (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111086266B (en) * 2019-12-30 2022-06-24 南京信捷泽荣智控技术有限公司 Self-adaptive variable-speed parking method and device for intelligent press
CN115139224B (en) * 2022-06-17 2024-06-11 中国第一汽车股份有限公司 Four-axis tool control method based on simulink
CN115284298B (en) * 2022-08-31 2024-07-02 深圳前海瑞集科技有限公司 Robot singular avoidance method, device, terminal and medium

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3806273B2 (en) * 1999-09-17 2006-08-09 株式会社ジェイテクト 4-DOF parallel robot
CN101543858B (en) * 2009-05-08 2010-09-29 南京理工大学 High speed precision press
CN101745820A (en) * 2009-12-14 2010-06-23 北京航空航天大学 Three-degree-of-freedom parallel mechanism type dual head for five-axis machine tools and control method
CN102025116B (en) * 2010-12-17 2012-11-14 安徽鑫龙电器股份有限公司 Interlocking device of high-tension switch gear
CN102645335B (en) * 2012-05-11 2014-08-20 天津工业大学 Method for locating top dead center of six cylinder engine
CN104148976B (en) * 2014-07-24 2016-05-25 深圳市领略数控设备有限公司 A kind of accurate digital control rotating shaft system
CN106426092B (en) * 2016-10-10 2019-03-22 燕山大学 Motion redundancy series parallel robot in five degrees of freedom
CN106736634B (en) * 2016-12-23 2018-09-25 南京理工大学 A kind of three translation parallel lathe of big working space of additional redundancy Circular Sliding

Also Published As

Publication number Publication date
CN109894906A (en) 2019-06-18

Similar Documents

Publication Publication Date Title
CN109894906B (en) Redundant drive parallel machine tool dead point avoidance system and method
US11796299B2 (en) Pipeline three-dimensional curve measuring robot and implementation method therefor
CN103753351B (en) A kind of Digit Control Machine Tool backlass monitoring method of Full-closed servo system
CN107839714A (en) A kind of the two-dimensional laser device for dynamically detecting and method of profile of steel rail and ripple mill
CN101377418B (en) Device and method for detecting contact type large-scale special-shaped glass outline based on rotating-rectilinear movements
CN102679898A (en) Real-time online full-auto measuring method and device for grating pitch
CN102103192B (en) Automatic positioning measuring device for one-way magnetic fields
CN101841295A (en) Linear motor motion control method based on fixed-step speed measurement
CN104129715A (en) Bridge type crane positioning system based on laser ranging and bar code positioning technology
CN102192999A (en) Probe-based automatic airflow pressure and velocity measurement device
CN103042670B (en) Automatic data sampling system of elbow injection molding machine
CN210981144U (en) Glass overall dimension detects platform
CN119085857B (en) Hanging rail type inspection robot with infrared temperature measurement function
CN109176503A (en) A kind of intelligent path detection robot and path detection method based on bionical antenna
CN205827202U (en) Experimental provision for the coal-winning machine Intelligent Control Strategy research of Multi-information acquisition
CN205496575U (en) High-precision non-contact movable radial runout detector
CN110133316B (en) A kind of photoelectric encoder precision speed measuring system and method
CN210134942U (en) Cutting control device of heading machine and cantilever heading machine
CN107139193A (en) The redundancy plane parallel mechanism control device and method of direct drive
CN114019950B (en) An intelligent inspection robot for apparent diseases of tunnel structures
CN103934819A (en) Manipulator and composite material large-scale shell automatic profile modeling system
CN210886859U (en) Road surface flatness detection device
CN103615999A (en) Motion synchronization precision detecting device based on linear motors
CN109129427B (en) Plane parallel mechanism device driven by double five-rod mechanism and control method
CN117047558A (en) Holographic sensing method and device for machine tool feeding system

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant