LINKAGE TURNTABLE AND DECOUPLING CONTROL METHOD THEREOF

Abstract

A decoupling control method for linkage turntable in the technical field of associative motion control mechanisms. Steps of the technical solution are as follows: measure a length L of a hypotenuse of a triangular structure; convert A-axis coordinates input to the system into Z0-axis coordinates according to Z0=L*cos α and input them on Z0-axis; and in the case of a speed control method, convert the A-axis coordinates into a periodic displacement of Z0 according to ΔZ0=L*(cos α.sub.1−cos α.sub.2), and input the displacement to Z0-axis. The beneficial effect is that the horizontal displacement generated by the movement of the Z0-axis is directly integrated into the closed loop of the X-axis by means of measurement combination and the displacement directly calculated by grating scale has high precision and no delay, and it is possible to achieve a more effective control level on this mechanical structure. In addition, the optimized control algorithm makes the X-axis have the motion characteristics of RTCP in the process of A-axis rotation, thereby reducing the requirements for the dynamic performance of the X-axis motor.

Claims

1. A linkage turntable, comprising: a turntable column (1); a linkage turntable (8); an X-axis grating scale reading head (10); an X-axis grating scale (13); a turntable base (14); a sliding mechanism A; and a sliding mechanism B, wherein the turntable column (1) is vertically mounted on the turntable base (14), the linkage turntable (8) is slidably connected to the turntable column (1) through the sliding mechanism A, the linkage turntable (8) is slidably connected to the turntable base (14) through the sliding mechanism B, the X-axis grating scale reading head (10) is mounted on the sliding mechanism B, and the X-axis grating scale (13) is mounted below the turntable base (14) and arranged opposite to the X-axis grating scale reading head (10).

2. The linkage turntable according to claim 1, wherein the sliding mechanism A includes: a Z0-axis ball screw (2); a Z0-axis ram (3); a first rotation node of linkage mechanism (4); a linkage of linkage mechanism (5); and a Z0-axis guide rail (6), the Z0-axis guide rail (6) is arranged on the turntable column (1), the Z0-axis ball screw (2) is connected to the Z0-axis guide rail (6), the Z0-axis ram (3) is slidably connected to the Z0-axis guide rail (6), one end of the linkage of linkage mechanism (5) is rotatably connected to the Z0-axis ram (3) through the first rotation node of linkage mechanism (4), and the other end of the linkage of linkage mechanism (5) is connected to the linkage turntable (8).

3. The linkage turntable according to claim 1, wherein the sliding mechanism B includes: a horizontal guide rail (7); a second rotation node of linkage mechanism (9); and a horizontal ram (11), wherein the horizontal guide rail (7) is arranged on the turntable base (14), the linkage turntable (8) is rotatably connected to the horizontal ram (11) through the second rotation node of linkage mechanism (9), the horizontal ram (11) is slidably connected to the horizontal guide rail (7), and the X-axis grating scale reading head (10) is mounted on the horizontal ram (11).

4. The linkage turntable according to claim 1, further comprising: a linkage turntable ram (12); a bed (15); a turntable guide rail (16); a turntable drag screw (17); and a turntable drag nut (18), wherein the bed (15) is provided with the turntable guide rail (16), the turntable drag screw (17) and the linkage turntable ram (12), the linkage turntable ram (12) is slidably connected to the turntable guide rail (16), and the turntable drag nut (18) is arranged on the turntable drag screw (17).

5. A decoupling control method for linkage turntable, comprising: S1. measure a length L of a hypotenuse of a triangular structure; and S2. convert A-axis coordinates input to the system into Z0-axis coordinates according to
Z0=L*cos α and input them on Z0-axis, wherein ZO represents the length of the nut position of Z0-axis relative to the reference point of Z0-axis, and the reference point is located at the intersection of the extension lines of the displacement trajectories of the two rotation nodes of the linkage mechanism, and α represents the angle of the turntable, that is, the angle between the turntable normal and the positive direction of the X′-axis; and in the case of a speed control method, convert the A-axis coordinates into a periodic displacement of Z0 according to
ΔZ0=L*(cos α.sub.1−cos α.sub.2) and input the displacement to Z0-axis, wherein ΔZ0 indicates the displacement of Z0-axis, α.sub.1 indicates the angle of the turntable before moving, and α.sub.2 indicates the angle of the turntable after moving.

6. The decoupling control method for linkage turntable according to claim 5, wherein the linkage turntable is assembled before measuring the length L of the hypotenuse of the triangular structure, and the assembly steps include: S0.1. mount the X-axis grating scale parallel to the X-axis on the bed; S0.2. align the X-axis grating scale reading head with the X-axis grating scale, fix the X-axis grating scale reading head on the horizontal ram, and repeatedly move the linkage turntable horizontally to check the readings; and S0.3. mount the circular grating of the linkage turntable coaxially facing the A-axis rotation center.

7. The decoupling control method for linkage turntable according to claim 5, wherein the steps of obtaining the length L of the hypotenuse of the triangular structure include: moving Z0 to the first position, recording the Z0 coordinate Z0.sub.1, the A-axis angle α.sub.1; moving Z0 to the second position, recording the Z0 coordinate Z0.sub.2, the turntable angle α.sub.2, and using the following equation:
L*cos α.sub.1−L*cos α.sub.2=Z0.sub.1−Z0.sub.2 to obtain the length L of the hypotenuse of the triangular structure:
L=ΔZ0/(cos α.sub.1−cos α.sub.2).

8. The decoupling control method for linkage turntable according to claim 5, wherein the detailed steps of step S2 include: S2.1. a command A0, that is, Δα, is sent to a Z0 controller; and a command X is sent to an X-axis controller; S2.2. the Z0 controller calculates the distance Δα that the A-axis needs to travel in the next cycle according to the command and the feedback of the A-axis angle, and the command angle Δα sent out includes a tracking error and a speed feedforward; and the A0-axis controller calculates the distance Δα that the A-axis needs to travel in the next cycle according to the command and the feedback of the A-axis angle, and the command angle Δα sent out includes a tracking error and a speed feedforward; and the X-axis performs the same process; S2.3. before Δα is input to the Z0 actuator, Δα is converted into the current straight-line distance ΔZ0 to be traveled by Z0 according to the equation ΔZ0=L(cos α.sub.1−cos(α.sub.1+Δα)), and then a command is sent to the Z0 actuator; and ΔX is sent to the X-axis actuator; S2.4, the Z0 actuator drives the turntable linkage mechanism to generate the A-axis swing angle change Δα′ and the X-axis direction horizontal displacement ΔX′, Δα′ is used to participate in the closed-loop operation of the next cycle; the X-axis actuator also generates a displacement ΔX.sub.0, ΔX.sub.0 and the horizontal displacement ΔX′ generated by the turntable linkage mechanism are combined to participate in the closed-loop operation of the next cycle; and S2.5. execute steps S2.1 to S2.4 periodically and cyclically.

Description

BRIEF DESCRIPTION OF DRAWINGS

[0032] FIG. 1 is the structure schematic diagram of the linkage turntable of the present invention.

[0033] FIG. 2 is a schematic diagram of a simplified motion process of a solution structure related to the prior art.

[0034] FIG. 3 is an algorithm diagram of a traditional control.

[0035] FIG. 4 is a schematic diagram of a decoupling control algorithm of the present invention.

[0036] FIG. 5 is a control flowchart of the decoupling control algorithm of the present invention.

[0037] Description of reference signs: 1—turntable column; 2—Z0-axis ball screw; 3—Z0-axis ram; 4—the first rotation node of linkage mechanism; 5—linkage of linkage mechanism; 6—Z0-axis guide rail; 7—horizontal guide rail; 8—linkage turntable; 9—the second rotation node of linkage mechanism; 10—X-axis grating scale reading head; 11—horizontal ram; 12—linkage turntable ram; 13—X-axis grating scale; 14—turntable base; 15—bed; 16—turntable guide rail; 17—turntable drag screw; 18—turntable drag nut.

DESCRIPTION OF EMBODIMENTS

[0038] The linkage turntable and the decoupling control method thereof will be further described below with reference to FIGS. 1-5.

Embodiment 1

[0039] A linkage turntable, including: a turntable column 1; a linkage turntable 8; an X-axis grating scale reading head 10; an X-axis grating scale 13; a turntable base 14; a sliding mechanism A; and a sliding mechanism B, wherein the turntable column 1 is vertically mounted on the turntable base 14, the linkage turntable 8 is slidably connected to the turntable column 1 through the sliding mechanism A, the linkage turntable 8 is slidably connected to the turntable base 14 through the sliding mechanism B, the X-axis grating scale reading head 10 is mounted on the sliding mechanism B, and the X-axis grating scale 13 is mounted below the turntable base 14, fixed to the bed and arranged opposite to the X-axis grating scale reading head 10.

[0040] Further, the sliding mechanism A includes: a Z0-axis ball screw 2; a Z0-axis ram 3; a first rotation node of linkage mechanism 4; a linkage of linkage mechanism 5; and a Z0-axis guide rail 6, the Z0-axis guide rail 6 is arranged on the turntable column 1, the Z0-axis ball screw 2 is connected to the Z0-axis guide rail 6, the Z0-axis ram 3 is slidably connected to the Z0-axis guide rail 6, one end of the linkage of linkage mechanism 5 is rotatably connected to the Z0-axis ram 3 through the first rotation node of linkage mechanism 4, and the other end of the linkage of linkage mechanism 5 is connected to the linkage turntable 8.

[0041] Further, the sliding mechanism B includes: a horizontal guide rail 7; a second rotation node of linkage mechanism 9; and a horizontal ram 11, wherein the horizontal guide rail 7 is arranged on the turntable base 14, the linkage turntable 8 is rotatably connected to the horizontal ram 11 through the second rotation node of linkage mechanism 9, the horizontal ram 11 is slidably connected to the horizontal guide rail 7, and the X-axis grating scale reading head 10 is mounted on the horizontal ram 11.

[0042] The linkage turntable further includes: a linkage turntable ram 12; a bed 15; a turntable guide rail 16; a turntable drag screw 17; and a turntable drag nut 18, wherein the bed 15 is provided with the turntable guide rail 16, the turntable drag screw 17 and the linkage turntable ram 12, the linkage turntable ram 12 is slidably connected to the turntable guide rail 16, the turntable drag nut 18 is arranged on the turntable drag screw 17, and the linkage turntable ram 12 is fixed on the turntable base 14 and is then slidably connected to the turntable guide rail 16 on the bed 15.

[0043] A decoupling control method for linkage turntable, including:

[0044] S1. measure a length L of a hypotenuse of a triangular structure; and

[0045] S2. convert A-axis coordinates input to the system into Z0-axis coordinates according to

Z0=L*cos α

and input them on Z0-axis, wherein Z0 represents the length of the nut position of Z0-axis relative to the reference point of Z0-axis, and the reference point is located at the intersection of the extension lines of the displacement trajectories of the two rotation nodes of the linkage mechanism, and α represents the angle of the turntable, that is, the angle between the turntable normal and the positive direction of the X′-axis;

[0046] and in the case of a speed control method, convert the A-axis coordinates into a periodic displacement of Z0 according to

ΔZ0=L*(cos α.sub.1−cos α.sub.2)

and input the displacement to Z0-axis, wherein ΔZ0 indicates the displacement of Z0-axis, α.sub.1 indicates the angle of the turntable before moving, and α.sub.2 indicates the angle of the turntable after moving.

[0047] Further, the linkage turntable is assembled before measuring the length L of the hypotenuse of the triangular structure, and the assembly steps include:

[0048] S0.1. mount the X-axis grating scale parallel to the X-axis on the bed;

[0049] S0.2. align the X-axis grating scale reading head with the X-axis grating scale, fix the X-axis grating scale reading head on the horizontal ram, and repeatedly move the linkage turntable horizontally to check the readings; and

[0050] S0.3. mount the circular grating of the linkage turntable coaxially facing the A-axis rotation center.

[0051] Further, the steps of obtaining the length L of the hypotenuse of the triangular structure include:

[0052] moving Z0 to the first position, recording the Z0 coordinate Z0.sub.1, the A-axis angle α.sub.1; moving Z0 to the second position, recording the Z0 coordinate Z0.sub.2, the turntable angle α.sub.2, and using the following equation:

L*cos α.sub.1−L*cos α.sub.2=Z0.sub.1−Z0.sub.2

to obtain the length L of the hypotenuse of the triangular structure:

L=ΔZ0/(cos α.sub.1−cos α.sub.2).

[0053] Further, the detailed steps of step S2 are as follows:

[0054] S2.1. a command A0, that is, Δα, is sent to a Z0 controller; and a command X is sent to an X-axis controller;

[0055] S2.2. the Z0 controller calculates the distance Δα that the A-axis needs to travel in the next cycle according to the command and the feedback of the A-axis angle, and the command angle Δα sent out includes a tracking error and a speed feedforward;

[0056] and the A0-axis controller calculates the distance Δα that the A-axis needs to travel in the next cycle according to the command and the feedback of the A-axis angle, and the command angle Δα sent out includes a tracking error and a speed feedforward; and the X-axis performs the same process;

[0057] S2.3. before Δα is input to the Z0 actuator, Δα is converted into the current straight-line distance ΔZ0 to be traveled by Z0 according to the equation ΔZ0=L(cos α.sub.1−cos(α.sub.1+Δα)), and then a command is sent to the Z0 actuator; and ΔX is sent to the X-axis actuator;

[0058] S2.4, the Z0 actuator drives the turntable linkage mechanism to generate the A-axis swing angle change Δα′ and the X-axis direction horizontal displacement ΔX′, Δα′ is used to participate in the closed-loop operation of the next cycle; the X-axis actuator also generates a displacement ΔX.sub.0, ΔX.sub.0 and the horizontal displacement ΔX′ generated by the turntable linkage mechanism are combined to participate in the closed-loop operation of the next cycle; and

[0059] S2.5. execute steps S2.1 to S2.4 periodically and cyclically.

Embodiment 2

[0060] Compared with the traditional control scheme, the modification is convenient and fast in the control method proposed in the present application, with low cost and obvious effect. The implementation of the technical solution described in this application only needs to refit the reading head of the X-axis from the turntable base to a turntable support slider.

[0061] The traditional control method is expressed on the algorithm schematic diagram shown in FIG. 3.

[0062] The schematic diagram of the control scheme mentioned in this application is shown in FIG. 4.

[0063] It should be noted that the dotted line part in the figure does not require additional implementation, only the mounting position of the X-axis reading head needs to be changed, and the X-axis control algorithm does not need to be changed.

[0064] In the traditional control algorithm, the displacement in the horizontal direction needs to be calculated according to Z0 and added to the command X, but here, since the reading head is mounted on the turntable support slider, for the horizontal displacement of the turntable caused by the movement of the Z0-axis, the real-time feedback displacement can be fed back to the closed loop of the X-axis through the grating scale (or other measuring device) in real time.

[0065] Assuming that the command X of the X-axis remains unchanged, it can be automatically realized that the horizontal center of the turntable remains unchanged during the Z0-axis dragging the turntable, that is, the left side of the X of the A-axis rotation center is always X1 in FIG. 2.

[0066] The unique advantages of this control structure are summarized as follows:

[0067] 1. Since the horizontal displacement of the turntable is measured by the grating scale, the part of calculating the horizontal displacement is omitted and manpower is saved.

[0068] 2. Since the horizontal displacement of the turntable is measured by the grating scale, it is possible to ensure the real-time and accuracy of the value, and ensure the accuracy of the control.

[0069] 3. In practical applications, since the reading head is mounted on the turntable support slider, the horizontal displacement generated by the turntable will be automatically added to the horizontal displacement feedback of the X-axis, and there is no need to make any changes to the control algorithm of the X-axis, thereby also saving manpower.

[0070] Steps of implementation

[0071] Assembly:

[0072] 1. mount the grating scale parallel to the X-axis on the bed, and proceed to Step 2 after checking that there is no mistake;

[0073] 2. align the X-axis grating scale reading head with the grating scale, fix it on the support slider of the horizontal turntable, and move the turntable horizontally repeatedly to check that the reading is normal and then proceed to Step 3; and

[0074] 3. mount the circular grating of the turntable coaxially facing the A-axis rotation center, and proceed to Step 4 after checking that there is no mistake repeatedly.

[0075] Measurement:

[0076] 4. measure the length of the hypotenuse of the triangular structure, move Z0 repeatedly after measuring the length, and verify whether the length of the hypotenuse, the A-axis angle and the Z0 coordinate can be perfectly matched to form a triangle, and proceed to Step 6 after completing the measurement, and if there are large differences among the triangles calculated at each position, the assembly should be rechecked and the implement should be restarted from Step 1, and if there is no accurate measuring device, proceed to Step 5;

[0077] 5. move Z0 to the first position, record the Z0 coordinate Z0.sub.1, the A-axis angle α.sub.1, and move Z0 to the second position, record the Z0 coordinate Z0.sub.2, the turntable angle α.sub.2, and since the turntable mechanical structure is mounted at a right angle, the length of the hypotenuse can be calculated according to the following equations, assuming that the length of the hypotenuse is L:

L*cos α.sub.1−L*cos α.sub.2=Z0.sub.1−Z0.sub.2

L=ΔZ0/(cos α.sub.1−cos α.sub.2)

and when calculating the result, a few more positions should be obtained to verify whether the calculated L is correct, and if the L values of repeated calculations are quite different, it means that the result of the mechanical assembly is not a right angle, and then the mechanical assembly should be checked carefully, and the implementation should be restarted from Step 1, and if it is considered that the calculated hypotenuse length is accurate enough, proceed to Step 6.

[0078] Algorithm:

[0079] 6. change the A-axis control method of the system, convert A-axis coordinates input to the system into Z0-axis coordinates according to the following Z0=L*sin α, and input them on the Z0-axis, and in the case of a speed control method, convert the A-axis coordinates into a periodic displacement (that is, speed) of Z0 according to

ΔZ0=L*(cos α.sub.1−cos α.sub.2)

and input the displacement to the Z0-axis, and other axes do not need to be changed,
and the flowchart of linkage decoupling control is shown in FIG. 5, and the steps are as follows:

[0080] 1. a command A0, that is, Δα, is sent to a Z0 controller; and a command X is sent to an X-axis controller;

[0081] 2. the A0 controller calculates the distance Δα that the A-axis needs to travel in the next cycle according to the command and the feedback of the A-axis angle, and the command angle Δα sent out includes a tracking error and a speed feedforward; and the same applies to ΔX;

[0082] 3. before Δα is input to the Z0 actuator, Δα is converted into the current straight-line distance ΔZ0 to be traveled by Z0 according to the equation, and then a command is sent to the Z0 actuator, which is generally a servo motor, a frequency converter, or other actuator; and ΔX is also sent to the X-axis actuator;

[0083] 4. the Z0 actuator drives the turntable linkage mechanism to generate the A-axis swing angle change Δα′ and the X-axis direction horizontal displacement ΔX′, Δα′ is used to participate in the closed-loop operation of the next cycle; the X-axis actuator also generates a displacement ΔX.sub.0, ΔX.sub.0 and the horizontal displacement ΔX′ generated by the turntable linkage mechanism are combined to participate in the closed-loop operation of the next cycle; and

[0084] 5. execute the steps above periodically and cyclically.

[0085] The above description is only a preferred embodiment of the present invention, but the protection scope of the present invention is not limited to this. Any equivalent replacements or changes made by a person skilled in the art within the technical scope disclosed by the present invention according to the technical solution of the present invention and the inventive concept thereof should be within the protection scope of the present invention.