Motion positioning control method and system for double XY platforms

Through three-dimensional modeling and relative gain array analysis, a decoupled control model is built, which solves the problem of synchronous control of dual XY platforms, and realizes high-precision and stable dual-motor driving, which is suitable for silicon wafer processing with high load and large strokes.

CN118963126AInactive Publication Date: 2024-11-15DONGGUAN PRECISION INTELLIGENT TECH CO LTD
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202411030074.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-30
Publication Date
2024-11-15
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

The prior art is difficult to realize a dual XY platform with high-precision synchronous control of dual motor drives, especially when the load position changes, and the adaptive control algorithm is complex.

Method used

The transfer function matrix of dual input and dual output model is obtained through three-dimensional modeling, and the coupling relationship is analyzed using relative gain arrays, a decoupling control model is constructed and the decoupling compensator and output transformation matrix are designed to realize the motion positioning control of the dual XY platform.

Benefits of technology

It effectively reduces the coupling relationship between the dual motors, simplifies the control system design, improves the control accuracy and stability of the bilateral drive precision XY motion platform, and is suitable for silicon wafer processing with large strokes and high loads.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118963126A_ABST
    Figure CN118963126A_ABST
Patent Text Reader

Abstract

The invention relates to the field of platform motion decoupling control, in particular to a motion positioning control method and system for double XY platforms, and the method comprises the steps: carrying out the three-dimensional modeling of the double XY platforms, and obtaining a double-input and double-output model transfer function matrix of a three-dimensional model of the double XY platforms; adopting a relative gain array to analyze a coupling relationship between the double-input and double-output models, and determining a control scheme of the double XY platforms based on the coupling relationship; constructing a decoupling control model based on the dual-input dual-output model transfer function matrix; and performing motion positioning control on the double XY platforms based on the decoupling control model. According to the method, bilateral driving decoupling system control is realized by adopting a decoupling compensator and an output transformation matrix, and the decoupling compensator and the output transformation matrix are designed to be related to the position parameters of the X-axis sliding block in consideration of the position parameter change of the X-axis sliding block; accurate control of the double-XY motion platform is realized under different parameter change conditions.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of platform motion decoupling control, and in particular to a motion positioning control method and system for a dual XY platform. Background Art

[0002] With the rapid development of the semiconductor industry, the integration of IC chips is getting higher and higher, and the requirements for their dedicated chip packaging equipment are getting higher and higher. As one of the core technologies of chip packaging equipment, the motion accuracy of high-performance precision motion platform directly affects the resolution, speed and acceleration of packaging equipment, thereby directly affecting the production efficiency of the equipment. In particular, as the size of silicon wafer processing becomes larger and larger, it not only requires high positioning accuracy, high trajectory tracking accuracy and high response speed, but also requires long stroke, large driving force and high load capacity.

[0003] Bilateral drive refers to the use of two motors to drive the movement in one direction, usually called H-drive structure. Bilateral drive structure has the advantages of large stroke, large driving force, high load, and high bandwidth, but the challenge of this type of platform is the need to complete high-precision synchronous control. At present, there are many control methods used to solve the problem of dual-motor synchronous control, such as using adaptive control strategies to coordinate the movement of dual motors to improve the synchronization accuracy; Tang Guangpu et al. studied the synchronous motion control of a symmetrical platform with strong mechanical coupling composed of a rotary motor + ball screw. Wu-Sung Yao et al. used independent control methods for the bilateral synchronous control of the linear motor and the crossbeam connected by hinges, without considering the impact of load position changes on the system model. Guo Hongche et al. used an ideal decoupling control strategy to decouple the dual-motor motion, and designed adaptive control for the decoupled SISO system, but the decoupling strategy is difficult to implement when the coupling is large, and the adaptive control algorithm is relatively complex.

[0004] Therefore, there is an urgent need for a motion positioning control method and system for a dual XY platform to solve the problems existing in the above-mentioned prior art. Summary of the invention

[0005] In order to overcome the problems existing in the prior art, the present invention aims to provide a motion positioning control method and system for a dual XY platform.

[0006] To achieve the above object, the present invention provides the following technical solution: a motion positioning control method of a dual XY platform, comprising the following steps:

[0007] S1: Performing three-dimensional modeling on the dual XY platform, and obtaining a dual-input dual-output model transfer function matrix of the three-dimensional model of the dual XY platform;

[0008] S2: using a relative gain array to analyze the coupling relationship between the dual-input and dual-output models, and determining a control scheme for the dual XY platform based on the coupling relationship;

[0009] S3: constructing a decoupling control model based on the dual-input dual-output model transfer function matrix;

[0010] S4: Performing motion positioning control on the dual XY platform based on the decoupling control model.

[0011] The present invention is further configured as follows: the dual XY motion platform includes a base, a beam and a slider; the base includes a passive vibration isolation system and marble; the beam is an asymmetric beam, and the beam is driven by two parallel first drive motors and a second drive motor to complete bilateral drive in the Y-axis direction; the slider is arranged on the beam, and the slider realizes movement in the X-axis direction through a third drive motor.

[0012] The present invention is further configured such that the dual-input dual-output model transfer function matrix includes the transfer function G of the displacement generated by the motor driving force of the first driving motor of the dual XY platform in the X-axis. 11 (s), the transfer function G of the displacement generated by the motor driving force of the first driving motor on the Y axis 12 (s), and the transfer function G of the displacement generated by the motor driving force of the second driving motor in the X-axis 21 (s), the transfer function G of the displacement generated by the motor driving force of the second driving motor on the Y axis 22 (s).

[0013] The present invention is further configured that, in step S2, the process of using the relative gain array to analyze the coupling relationship between the dual-input and dual-output models includes:

[0014] Constructing a relative gain array according to the dual-input dual-output model transfer function matrix;

[0015] Based on the transfer function G 11 (s), transfer function G 12 (s), transfer function G 21 (s), transfer function G 22 (s) calculating relative gain function;

[0016] The relative gain function is subjected to non-decoupling analysis to obtain the coupling relationship of each parameter in the dual XY platform.

[0017] The present invention is further configured that, in step S3, the process of constructing a decoupling control model based on the dual-input dual-output model transfer function matrix includes:

[0018] Construct a decoupling control model framework based on the decoupling control principle;

[0019] Designing a series controller for the decoupling control model framework based on the coupling relationship;

[0020] Performing a running simulation on the dual XY platform three-dimensional model, acquiring and recording the real-time position of the X-axis movement, and designing a decoupling compensator and an output transformation matrix of the decoupling control model framework according to the real-time position of the X-axis movement;

[0021] The decoupling control model is constructed based on the dual-input dual-output model transfer function, the series controller, the decoupling compensator and the output transformation matrix.

[0022] The present invention is further configured such that the output transformation matrix is ​​as shown below:

[0023]

[0024] in, represents the output transformation matrix, l represents the distance between the points of action of the driving force of the first driving motor and the second driving motor, x g Indicates the distance from the center of mass of the beam in the dual XY platform to the first drive motor along the Y axis, x s represents the distance between the X-axis slider and the first drive motor, and η represents the mass ratio of the X-axis slider to the crossbeam.

[0025] The present invention is further configured such that the output transformation matrix is ​​as shown below:

[0026]

[0027] in, Denotes a decoupling compensator.

[0028] The present invention also includes a motion positioning control system for a dual XY platform, which is used in conjunction with the motion positioning control method for the dual XY platform, and includes an operation simulation module, a control scheme generation module, a model construction module, and a motion positioning control module connected in sequence;

[0029] The operation simulation module is used to perform three-dimensional modeling on the dual XY platform to obtain a three-dimensional model of the dual XY platform;

[0030] The control scheme generation module is used to obtain the dual-input dual-output model transfer function matrix of the dual XY platform three-dimensional model, use the relative gain array to analyze the coupling relationship between the dual-input dual-output models, and determine and output the motion control scheme of the dual XY platform according to the coupling relationship;

[0031] The model building module is used to build a decoupling control model according to the dual-input dual-output model transfer function matrix;

[0032] The motion positioning control module is used to perform motion positioning control on the dual XY platform according to the output result of the decoupling control model.

[0033] The present invention is further configured that the control scheme generation module obtains the transfer function G of the displacement generated by the motor driving force of the first driving motor in the dual XY platform on the X axis 11 (s), the transfer function G of the displacement generated by the motor driving force of the first driving motor on the Y axis 12 (s), and the transfer function G of the displacement generated by the motor driving force of the second driving motor in the X-axis 21 (s), the transfer function G of the displacement generated by the motor driving force of the second driving motor on the Y axis 22 (s), and then construct the transfer function matrix of the dual-input dual-output model;

[0034] The control scheme generation module constructs a relative gain array according to the transfer function matrix of the dual-input dual-output model; 11 (s), transfer function G 12 (s), transfer function G 21 (s), transfer function G 22 (s) calculating a relative gain function; performing a non-decoupling analysis on the relative gain function to obtain a coupling relationship between parameters in the dual XY platform.

[0035] The present invention is further configured that the model building module builds a decoupling control model framework of the dual XY platform based on the decoupling control principle;

[0036] A series controller is designed for the decoupling control model framework according to the coupling relationship; a decoupling compensator and an output transformation matrix of the decoupling control model framework are designed according to the real-time position of the X-axis movement by recording the real-time position of the X-axis movement; and the decoupling control model is constructed based on the dual-input dual-output model transfer function, the series controller, the decoupling compensator and the output transformation matrix.

[0037] In summary, the beneficial effects of the above technical solution of the present invention are as follows:

[0038] The present invention proposes an ecological source identification and evaluation method that takes into account both landscape influence and biodiversity information, thereby improving the accuracy of ecological source identification and evaluation, and being able to more accurately reflect the ecological protection value of ecological sources, thereby improving the defect of existing methods that cannot reflect biodiversity information, and providing technical support for the construction of regional ecological networks and security patterns. BRIEF DESCRIPTION OF THE DRAWINGS

[0039] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the accompanying drawings required for describing the embodiments will be briefly introduced below. Obviously, the accompanying drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other accompanying drawings can be obtained based on these accompanying drawings without paying creative work.

[0040] Figure 1 is a flow chart of a motion positioning control method of a dual XY platform in an embodiment of the present invention;

[0041] Figure 2 is the relationship between the relative gain matrix value and the frequency in the embodiment of the present invention;

[0042] Figure 3 Schematic diagram of simulation results in an embodiment of the present invention;

[0043] Figure 4 It is a structural diagram of the motion positioning control system of the dual XY platform in an embodiment of the present invention. DETAILED DESCRIPTION

[0044] In order to enable those skilled in the art to better understand the technical solution of the present invention, the technical solution of the present invention is clearly and completely described below in conjunction with the accompanying drawings of the present invention. Based on the embodiments of the present invention, other similar embodiments obtained by ordinary technicians in the field without making any creative work should all fall within the scope of protection of the present invention.

[0045] The present invention will be further described below in conjunction with the accompanying drawings and preferred embodiments.

[0046] Embodiment 1:

[0047] like Figure 1 As shown in the figure, a preferred embodiment of the present invention is a motion positioning control method of a dual XY platform, comprising the following steps:

[0048] S1: Performing three-dimensional modeling on the dual XY platform, and obtaining a dual-input dual-output model transfer function matrix of the three-dimensional model of the dual XY platform;

[0049] The dual XY motion platform consists of three parts: one is a base composed of a vibration isolator and marble; the second is a beam (H-drive) that completes the Y-direction motion; and the third is a slider (X-slide) that completes the X-direction motion, which will be used to carry the moving object. The base is made of marble, and the passive vibration isolation system consists of four air spring vibration isolators. The asymmetric beam is driven by two parallel linear motors to complete bilateral drive. The X slider is driven by a linear motor to achieve X-direction motion. The measurement system uses three linear grating rulers arranged along the motion direction of the linear motor. The platform can achieve large-stroke linear motion in the X and Y directions, as well as micro-angle rotation around the Z axis.

[0050] The transfer function matrix of the double-side drive double-input double-output model can be expressed as:

[0051]

[0052] Among them, G 11 Indicates the driving force F of the first driving motor y1 Transfer function to displacement y1, G 21 Indicates the first motor driving force F y2 Transfer function to displacement y2, G 12 Indicates the second motor driving force F y2 Transfer function to displacement y2, G 22 Indicates the second motor driving force F y2 Transfer function to displacement y2.

[0053] S2: using a relative gain array to analyze the coupling relationship between the dual-input and dual-output models, and determining a control scheme for the dual XY platform based on the coupling relationship;

[0054] Constructing a relative gain array according to the dual-input dual-output model transfer function matrix;

[0055] Based on the transfer function G 11 (s), transfer function G 12 (s), transfer function G 21 (s), transfer function G 22 (s) calculating relative gain function;

[0056] The relative gain function is subjected to non-decoupling analysis to obtain the coupling relationship of each parameter in the dual XY platform.

[0057] It can be seen from the transfer function matrix that any output does not depend on an input, that is, there is a cross-influence between the input and the output. And when the system is closed in any way, this cross-influence relationship may become more complicated. This one input corresponds to multiple outputs, or one output is affected by multiple inputs, which is called interconnection, also known as coupling. In order to obtain the coupling relationship between the dual-input and dual-output models of the object, this embodiment uses a relative gain array M for analysis.

[0058]

[0059] in:

[0060]

[0061] The non-decoupling analysis of the dual XY motion platform shows that:

[0062] m 11 =m 22 >25 (5)

[0063] m 12 =m 21 <0 (6)

[0064] In this case, equations (5) and (6) indicate that the system is severely interconnected, and it is likely that the closed loop is unstable or has a reverse response. Simple multi-loop control cannot be used, and decoupling is required to obtain better control performance.

[0065] S3: constructing a decoupling control model based on the dual-input dual-output model transfer function matrix;

[0066] In order to realize MMO (Multiple Input Multiple Output) decoupling control, this embodiment designs a decoupling control model framework for the dual XY motion platform. In the model framework, G(s) represents the transfer function matrix, K(s) is the decoupling compensator designed to change the object characteristics, L(s) is the output transformation matrix, and C(s) is the series controller.

[0067] Let Q(s)=K(s)G(s)L(s) (7)

[0068] If we can obtain a suitable decoupling compensator K(s) and output transformation matrix K(s), we can obtain Q(s) in a diagonal form, namely:

[0069] Q(s)=diag{q i (s)} (8)

[0070] In this case, the system can be decoupled into an independent SISO system for control, which makes it easier to adopt control strategies suitable for SISO systems, such as designing complex robust controllers.

[0071] In order to realize decoupling control, it is necessary to design the decoupling compensator K(s), the output transformation matrix L(s) and the series controller C(s) according to the object transfer function matrix G(s).

[0072] Define u c =[u y u θ ] T ,u=[[u y1 u y2 ] T ,y G =[y1y2] T , y=[yθ] T , assuming that the distance between the points of action of the two linear motor driving forces is l, and the distance from the driving force in the Y-axis direction to the center of mass of the system is l g , thus we can get:

[0073] y=L(s)y G (9)

[0074] u=K(s)u c (10)

[0075] Where: u c is the transfer function from the series controller C(s) to the decoupling compensator K(s), u is the transfer function from the decoupling compensator K(s) to the transfer function matrix G(s), y G represents the transfer function from the transfer function matrix G(s) to the output transformation matrix L(s), y represents the control function output by the output transformation matrix L(s), y1 represents the translation displacement generated by the first drive motor, y2 represents the translation displacement generated by the second drive motor; θ represents the rotation angle of the slider around the z-axis;

[0076]

[0077] From formula (7), formula (11) and formula (12), we can get:

[0078]

[0079] Since the expression of Q(s) is relatively complex, it is not easy to use analytical methods to analyze the coupling relationship between Q(s) elements. We use the relative gain matrix M to analyze the coupling relationship between the input and output channels after decoupling. Take 1 = 0.85mb = 0.40m, and the relative gain matrix analysis results are as follows: Figure 2 As shown, the horizontal axis represents the frequency and the vertical axis represents the relative gain matrix value. Figure 2 The a figure in the figure represents m 11 Relationship between relative gain matrix values ​​and frequency; Figure 2 The b figure in the figure represents m 12 Relationship between relative gain matrix values ​​and frequency; Figure 2 The c graph in the figure represents m 21 Relationship between relative gain matrix values ​​and frequency; Figure 2 The d graph in the figure represents m 22 Relationship between relative gain matrix values ​​and frequency.

[0080] The static relative gain matrix (i.e., the relative gain matrix value when the frequency is 0 rad / sec) is as follows:

[0081]

[0082] Depend on Figure 2 It can be concluded that for the dual XY motion platform in this embodiment, this decoupling strategy makes the coupling effect between channels less than 0.015, and the coupling effect between the two channels can be treated as a disturbance. At the same time, because the bilateral drive has resonance and anti-resonance characteristics, this decoupling strategy cannot obtain an absolute main diagonal element of 1. At the same time, the system simulation in Part 3 can also verify that this strategy can obtain a better decoupling control effect. Therefore, the synchronous control of the two linear motors driven by the bilateral drive can convert the control of the bilateral drive precision XY motion platform into the SFO system for control through the decoupling compensator and the output transformation matrix, that is, the translation y along the center of mass and the rotation Q around the center of mass, thereby reducing the difficulty of control system design.

[0083] The controller C(s) is designed based on the main diagonal elements of Q(s) and the PID control law is adopted. The expression is as follows:

[0084]

[0085] Among them, c1(s) and c2(s) are the control functions of the first drive motor and the second drive motor respectively, K p1 , K D1 , K I1 represents the control parameter of the first drive motor, K p2 , K D2 , K I2 Indicates the control parameters of the second drive motor.

[0086] The dual XY motion platform needs to complete a large-stroke two-degree-of-freedom motion. The movement of the X-axis slider will inevitably change the position of the system's center of mass, making the system a parameter-changing system. This embodiment designs a decoupling compensator and an output transformation matrix based on the real-time position of the X-axis slider to complete the decoupling control of the bilateral drive parameter change of the dual XY motion platform. Assume that the mass ratio of the X-slider to the asymmetric beam is x, and the distance from the X-axis slider to the first drive motor is x. s , the distance between the center of mass of the asymmetric beam and the first drive motor along the Y direction is x g , then l g It can be expressed as x s The function of η represents the mass ratio of the X-axis slider to the beam. As shown below:

[0087]

[0088] According to formula (7), the model can be expressed as follows:

[0089]

[0090] During the movement of the X-axis slider, the object model is represented as The output transformation matrix is ​​expressed as The decoupling compensator is expressed as From formula (11-12) and formula (17), we can get:

[0091]

[0092] l represents the distance between the points of action of the driving forces of the first driving motor and the second driving motor, x g Indicates the distance from the center of mass of the beam in the dual XY platform to the first drive motor along the Y axis, x s represents the distance between the X-axis slider and the first drive motor, and η represents the mass ratio of the X-axis slider to the crossbeam.

[0093]

[0094] S4: Performing motion positioning control on the dual XY platform based on the decoupling control model.

[0095] By changing the parameters of the decoupling compensator and the output transformation matrix, the model Q(s) can be kept unchanged during the movement of the axis slider, and decoupling control can be achieved, thus avoiding the difficulty of redesigning the controller due to changes in the control object in cross-coupling, master-slave and other control methods.

[0096] In order to verify the effectiveness of the decoupling control strategy designed in this embodiment, a simulation experiment was conducted on the system model represented by equation (1). The experiment was simulated using MATLAB / S MULINK. The simulation parameters of the bilateral drive precision motion platform are as follows: the mass of the asymmetric beam m1 = 39.4 kg. The mass ratio of the X-axis slider to the asymmetric beam = 0.4, the length l = 0.85 m, and the position of the X-axis slider x s ∈(0.15 0.70)m.

[0097] The adaptive decoupling compensator and output transformation matrix can be obtained by equation (19-20). The controller parameters are determined by simulation. At time t = 1s, a 1004m step is applied to the system, and at l = 1.5s and 2.0s, the same magnitude of disturbance force is applied to the master motor side and the slave motor side respectively.

[0098] Depend on Figure 3 As shown, Figure 3 Figure a shows the relationship between the Y-axis moving distance and the moving time; Figure 3 Figure b shows the relationship between the angle θ and the moving time. It can be seen that the decoupling control strategy can obtain stable control performance, has a fast response to the Y-direction step signal, and the angle θ has a small error. In terms of disturbance suppression, it can achieve a good suppression effect on the motor force disturbance. The simulation results show the effectiveness of the decoupling control strategy described in this paper.

[0099] Embodiment 2:

[0100] This embodiment also specifically proposes a motion positioning control system for a dual XY platform for implementing the above method, such as Figure 4 As shown, it includes an operation simulation module, a control scheme generation module, a model building module, and a motion positioning control module connected in sequence;

[0101] The operation simulation module is used to perform three-dimensional modeling on the dual XY platform to obtain a three-dimensional model of the dual XY platform.

[0102] The control scheme generation module is used to obtain the dual-input dual-output model transfer function matrix of the dual XY platform three-dimensional model, use the relative gain array to analyze the coupling relationship between the dual-input dual-output models, and determine and output the motion control scheme of the dual XY platform according to the coupling relationship;

[0103] The control scheme generation module obtains the transfer function G of the displacement generated by the motor driving force of the first driving motor in the dual XY platform in the X-axis 11 (s), the transfer function G of the displacement generated by the motor driving force of the first driving motor on the Y axis 12 (s), and the transfer function G of the displacement generated by the motor driving force of the second driving motor in the X-axis21 (s), the transfer function G of the displacement generated by the motor driving force of the second driving motor on the Y axis 22 (s), and then construct the transfer function matrix of the dual-input dual-output model.

[0104] The control scheme generation module constructs a relative gain array according to the transfer function matrix of the dual-input dual-output model; 11 (s), transfer function G 12 (s), transfer function G 21 (s), transfer function G 22 (s) calculating a relative gain function; performing a non-decoupling analysis on the relative gain function to obtain a coupling relationship between parameters in the dual XY platform.

[0105] The model construction module is used to construct a decoupling control model according to the dual-input dual-output model transfer function matrix; design a series controller for the decoupling control model framework according to the coupling relationship; design a decoupling compensator and an output transformation matrix of the decoupling control model framework according to the real-time position of the X-axis movement by recording the real-time position of the X-axis movement; and construct the decoupling control model based on the dual-input dual-output model transfer function, the series controller, the decoupling compensator and the output transformation matrix.

[0106] The motion positioning control module is used to perform motion positioning control on the dual XY platform according to the output result of the decoupling control model.

[0107] In summary, the present invention realizes the decoupling control of two linear motors of bilaterally driven precision XY motion platform by designing decoupling compensator and output transformation matrix. Meanwhile, considering that the object is a parameter changing system, the excellent decoupling control performance under the parameter changing condition is realized.

[0108] Those skilled in the art will appreciate that embodiments of the present invention may be provided as systems or computer program products. Therefore, the present invention may take the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Furthermore, the present invention may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CDROM, optical storage, etc.) containing computer-usable program codes.

[0109] The present invention is described with reference to the flowcharts and / or block diagrams of computer program products according to embodiments of the present invention. It should be understood that each process and / or block in the flowcharts and / or block diagrams, as well as the combination of processes and / or blocks in the flowcharts and / or block diagrams, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the process in the flowchart. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0110] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0111] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0112] Finally, it should be noted that the above content is only used to illustrate the technical solution of the present invention, rather than to limit the scope of protection of the present invention. Simple modifications or equivalent substitutions of the technical solution of the present invention by ordinary technicians in this field do not deviate from the essence and scope of the technical solution of the present invention.

Claims

1. A motion positioning control method for a dual XY platform, characterized in that: The following steps are involved: S1: Performing three-dimensional modeling on the dual XY platform, and obtaining a dual-input dual-output model transfer function matrix of the three-dimensional model of the dual XY platform; S2: using a relative gain array to analyze the coupling relationship between the dual-input and dual-output models, and determining a control scheme for the dual XY platform based on the coupling relationship; S3: constructing a decoupling control model based on the dual-input dual-output model transfer function matrix; S4: Performing motion positioning control on the dual XY platform based on the decoupling control model.

2. The motion positioning control method of the dual XY platform according to claim 1, characterized in that: The dual XY motion platform includes a base, a beam and a slider; the base includes a passive vibration isolation system and marble; the beam is an asymmetric beam, and the beam is driven by two parallel first drive motors and a second drive motor to complete bilateral drive in the Y-axis direction. The slider is arranged on the beam, and the slider realizes movement in the X-axis direction through a third drive motor.

3. The motion positioning control method of the dual XY platform according to claim 2, characterized in that: The dual-input dual-output model transfer function matrix includes the transfer function G of the displacement generated by the motor driving force of the first driving motor of the dual XY platform in the X-axis 11 (s), the transfer function G of the displacement generated by the motor driving force of the first driving motor on the Y axis 12 (s), and the transfer function G of the displacement generated by the motor driving force of the second driving motor in the X-axis 21 (s), the transfer function G of the displacement generated by the motor driving force of the second driving motor on the Y axis 22 (s).

4. The motion positioning control method of the dual XY platform according to claim 3, characterized in that: In step S2, the process of using the relative gain array to analyze the coupling relationship between the dual-input and dual-output models includes: Constructing a relative gain array according to the dual-input dual-output model transfer function matrix; Based on the transfer function G 11 (s), transfer function G 12 (s), transfer function G 21 (s), transfer function G 22 (s) calculating relative gain function; The relative gain function is subjected to non-decoupling analysis to obtain the coupling relationship of each parameter in the dual XY platform.

5. The motion positioning control method of the dual XY platform according to claim 2, characterized in that: In step S3, the process of constructing a decoupling control model based on the dual-input dual-output model transfer function matrix includes: Construct a decoupling control model framework based on the decoupling control principle; Designing a series controller for the decoupling control model framework based on the coupling relationship; Performing a running simulation on the dual XY platform three-dimensional model, acquiring and recording the real-time position of the X-axis movement, and designing a decoupling compensator and an output transformation matrix of the decoupling control model framework according to the real-time position of the X-axis movement; The decoupling control model is constructed based on the dual-input dual-output model transfer function, the series controller, the decoupling compensator and the output transformation matrix.

6. The motion positioning control method of the dual XY platform according to claim 5, characterized in that: The output transformation matrix is ​​shown as follows: in, represents the output transformation matrix, l represents the distance between the points of action of the driving force of the first driving motor and the second driving motor, x g Indicates the distance from the center of mass of the beam in the dual XY platform to the first drive motor along the Y axis, x s represents the distance between the X-axis slider and the first drive motor, and η represents the mass ratio of the X-axis slider to the crossbeam.

7. The motion positioning control method of the dual XY platform according to claim 5, characterized in that: The output transformation matrix is ​​shown as follows: in, Denotes a decoupling compensator.

8. A motion positioning control system for a dual XY platform, used in conjunction with the motion positioning control method for a dual XY platform according to any one of claims 1 to 7, characterized in that: It includes an operation simulation module, a control scheme generation module, a model building module, and a motion positioning control module which are connected in sequence; The operation simulation module is used to perform three-dimensional modeling on the dual XY platform to obtain a three-dimensional model of the dual XY platform; The control scheme generation module is used to obtain the dual-input dual-output model transfer function matrix of the dual XY platform three-dimensional model, use the relative gain array to analyze the coupling relationship between the dual-input dual-output models, and determine and output the motion control scheme of the dual XY platform according to the coupling relationship; The model building module is used to build a decoupling control model according to the dual-input dual-output model transfer function matrix; The motion positioning control module is used to perform motion positioning control on the dual XY platform according to the output result of the decoupling control model.

9. The motion positioning control system of the dual XY platform according to claim 8, characterized in that: The control scheme generation module obtains the transfer function G of the displacement generated by the motor driving force of the first driving motor in the dual XY platform in the X-axis 11 (s), the transfer function G of the displacement generated by the motor driving force of the first driving motor on the Y axis 12 (s), and the transfer function G of the displacement generated by the motor driving force of the second driving motor in the X-axis 21 (s), the transfer function G of the displacement generated by the motor driving force of the second driving motor on the Y axis 22 (s), and then construct the transfer function matrix of the dual-input dual-output model; Construct a relative gain array according to the transfer function matrix of the dual-input dual-output model; construct a relative gain array according to the transfer function G 11 (s), transfer function G 12 (s), transfer function G 21 (s), transfer function G 22 (s) calculating a relative gain function; performing a non-decoupling analysis on the relative gain function to obtain a coupling relationship between parameters in the dual XY platform.

10. The motion positioning control system of the dual XY platform according to claim 8, characterized in that: The model building module builds a decoupling control model framework of the dual XY platform based on the decoupling control principle; A series controller is designed for the decoupling control model framework according to the coupling relationship; a decoupling compensator and an output transformation matrix of the decoupling control model framework are designed according to the real-time position of the X-axis movement by recording the real-time position of the X-axis movement; and the decoupling control model is constructed based on the dual-input dual-output model transfer function, the series controller, the decoupling compensator and the output transformation matrix.

Citation Information

Patent Citations

  • Center-of-gravity-driven parallel XY motion platform and control system thereof

    CN106863267A

  • Coupling identification and decoupling control design method of two-degree-of-freedom servo cradle head system

    CN111273553A