Dual-drive gantry drive control method, system, storage medium and processor

By collecting position errors on the dual-axis gantry platform and using the main command parallel control method for compensation, the problem of radial stress of the dual-axis gantry in high-speed and high-precision state is solved, the calculation model is simplified, and the structural life and real-time operation are improved. sex.

CN118244681BActive Publication Date: 2024-11-22HEFEI ANXIN PRECISION TECH CO LTD
View PDF 5 Cites 0 Cited by

Patent Information

Application Number
CN202410532734.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-04-30
Publication Date
2024-11-22
Estimated Expiration
2044-04-30

AI Technical Summary

Technical Problem

The existing dual-axis gantry driving control method is difficult to avoid radial stress between the two axes in high speed and high accuracy state, and the model is complex and the calculation is complex, which affects the life of the gantry structure.

Method used

The real-time position error of the double-axis is collected in the two-axis release state of the gantry platform, and the dual-axis is driven by the main command parallel control method, and the position error is used as the compensation amount of the slave axis to update the curve plan of the slave axis to eliminate the radial response of the double-drive gantry force, simplify the computational model.

Benefits of technology

It realizes the avoidance of radial stress on the biaxial gantry under high speed and high accuracy, improves the life of the gantry structure, simplifies the calculation model, and improves the real-time logic operation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118244681B_ABST
    Figure CN118244681B_ABST
Patent Text Reader

Abstract

The embodiment of the present invention provides a dual-drive gantry drive control method, system, storage medium and processor, which relates to the field of automatic control technology of numerical control machine tools. The method comprises the following steps: when the dual-axis of the gantry platform is released, the gantry is driven to collect the real-time position of the dual-axis to obtain the gantry position error of the slave axis relative to the main axis; the dual axis is driven by the master command parallel control method, and each position error is used as the compensation amount of the slave axis to update the curve planning of the slave axis to eliminate the radial force of the dual-drive gantry. This solution can avoid the radial force of the dual-axis gantry and meet the requirements of simple model and convenient calculation.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of automatic control of numerically controlled machine tools, and in particular to a dual-drive gantry drive control method, system, storage medium and processor. Background Art

[0002] Dual-drive gantry platforms are widely used in precision manufacturing fields such as semiconductors, wafer inspection, and large machine tools. At present, there are three main dual-axis gantry drive methods: master-slave control method: one motor shaft is used as the main shaft, and the main shaft directly executes the input trajectory command, and its position feedback signal is directly used as the input trajectory command of the slave shaft motor, that is, the slave shaft motor follows the movement of the main shaft motor; master parallel control method: two motors are combined into one shaft, and the two motors receive exactly the same trajectory command. Each motor has its own independent servo loop, and the independent loop is used to make their respective motion trajectories fit the command trajectory as much as possible; cross-coupling control method: on the basis of the master parallel control method, the dual-axis motor position error is compensated by the dual-axis motor position error controller to control the dual-axis motor position error within a certain threshold, and the model can be used to further compensate for the disturbance caused by the change of load position on the gantry.

[0003] Among the current control methods for dual-axis drives, the cross-coupling control method is better than the master-command parallel control method, and the master-command parallel control method is better than the master-slave control method. The cross-coupling control method takes into account the coupling between the two axes and can maintain high accuracy and motion state at high speed and high acceleration. However, an additional controller is required to control the errors of the two axes and compensate them to the next controller. The model is complex and the loop gain is difficult to adjust. The master-command parallel control method only needs to adjust the gain of a single channel, and the other channel can be reused. The model is simple and easy to adjust, but the mutual influence between the two axes is ignored.

[0004] In addition, in actual application systems, due to the differences in the structures of the dual axes (parallelism and straightness, etc.) and the driving parts (hardware and transmission structure, etc.), although the existing technology maintains the same movement distance of the dual axes during movement, the vertical movement distance reflected on the guide rail is different, so there will be a problem of mutual pulling between the dual axes, and the gantry cannot be in a natural state. This will cause the dual-drive gantry platform to always bear radial force, reducing the life of the gantry structure.

[0005] Therefore, the prior art lacks a high-speed and high-precision dual-axis gantry driving solution that can avoid radial force on the dual-axis gantry and satisfy the requirements of simple model and convenient calculation. Summary of the invention

[0006] In order to solve the problems in the prior art, the purpose of the embodiments of the present invention is to provide a dual-drive gantry drive control method, system, storage medium and processor, which can not only avoid radial force on the dual-axis gantry, but also meet the requirements of simple model and convenient calculation.

[0007] To achieve the above object, a control method for a dual-drive gantry drive according to a first aspect of an embodiment of the present invention includes the following steps:

[0008] In the state where the two axes of the gantry platform are released, push the gantry to collect the real-time positions of the two axes, and obtain the gantry position error of the slave axis relative to the master axis;

[0009] Drive the two axes using the master command parallel control method, and at the same time update the curve planning of the slave axis by taking each position error as the compensation amount of the slave axis to eliminate the radial force on the dual-drive gantry.

[0010] Preferably, the calculation formula for the position error is as follows:

[0011] Where x represents the current position of the slave axis, x0 represents the previous position of the current position x of the slave axis, x1 represents the next position of the current position x of the slave axis, x0 < x < x1, y represents the current position error, y0 represents the position error corresponding to x0, and y1 represents the position error corresponding to x1.

[0012] Preferably, the step of updating the curve planning of the slave axis by taking each position error as the compensation amount of the slave axis in real time is specifically: before each curve planning, add the corresponding position error as the compensation amount to the trajectory position of the slave axis as the given position of the position controller, and the master axis remains at the original trajectory position.

[0013] Preferably, the step of updating the curve planning of the slave axis by taking each position error as the compensation amount of the slave axis in real time is specifically: before each curve planning, keep the trajectory position unchanged, take the equivalent feedback position of the slave axis as the feedback position of the slave axis position controller, and the equivalent feedback position of the slave axis is equal to the feedback position at the motor end at the current moment minus the corresponding compensation amount, and the master axis remains at the original trajectory position.

[0014] Preferably, the method further includes: saving data after obtaining the gantry position error of the slave axis relative to the master axis, reading the data after each power-on, and then performing curve planning to drive the two axes.

[0015] Preferably, the method directly compensates the compensation amount to the given amount or feedback amount of the slave axis position controller, without using a controller to control the position error of the two axes in real time and without compensating the compensation amount to the speed loop controller.

[0016] A second aspect of an embodiment of the present invention provides a control system for a dual-drive gantry drive, including:

[0017] A compensation amount acquisition module, configured to, in the state where the two axes of the gantry platform are released, push the gantry to collect the real-time positions of the two axes, and obtain the gantry position error of the slave axis relative to the master axis;

[0018] The drive compensation module is used to drive the dual axes using the master command parallel control method, and at the same time use each position error as the compensation amount of the slave axis to update the curve planning of the slave axis to eliminate the radial force of the dual-drive gantry.

[0019] Preferably, it also includes:

[0020] A compensation data storage module is implemented based on a flash chip and is used to store compensation data;

[0021] The compensation data update module is used for updating the compensation data of the dedicated servo host computer through the communication protocol.

[0022] A third aspect of an embodiment of the present invention provides a machine-readable storage medium, on which instructions are stored, and the instructions are used to enable a machine to execute the control method of the dual-drive gantry drive mentioned above in the present application.

[0023] A fourth aspect of an embodiment of the present invention provides a processor for running a program, wherein the program, when being run, is used to execute: a control method for a dual-drive gantry drive as described above.

[0024] Through the above technical solution, the position error of the two axes is first collected when the gantry platform is in the released state, so as to determine the relative position error of the two ends of the gantry on the two axes when the radial force is 0, and the master-slave axis movement is driven by the master-slave axis parallel control method. The curve planning path of the master axis remains unchanged, and the relative position error is used as the compensation amount to compensate the curve planning of the slave axis to ensure that the movement of the gantry on the two axes follows the position path collected in the released state to eliminate the radial force of the dual-drive gantry. The above technical solution takes into account the dual-axis coupling and adopts a simple calculation method. It does not require a complex model to couple the dual-axis position relationship, avoids complex dual-axis coupling model calculations, and improves the real-time operation of the logic; on the basis of the master control method, the dual-axis coupling compensation strategy is combined to avoid the continuous force deformation of the gantry and improve the structural life, thereby realizing a high-speed and high-precision dual-axis gantry drive that can avoid the radial force of the dual-axis gantry and meet the simple and convenient model calculation.

[0025] Other features and advantages of the embodiments of the present invention will be described in detail in the subsequent detailed description. BRIEF DESCRIPTION OF THE DRAWINGS

[0026] The accompanying drawings are used to provide a further understanding of the embodiments of the present invention and constitute a part of the specification. Together with the following specific implementations, they are used to explain the embodiments of the present invention, but do not constitute a limitation on the embodiments of the present invention. In the accompanying drawings:

[0027] Figure 1 This is a schematic diagram of a curve planning of updating a slave axis in real time with a first compensation amount according to an embodiment of the present invention;

[0028] Figure 2 It is a schematic diagram of curve planning of the slave axis with real-time update of the second compensation amount in the embodiment of the present invention;

[0029] Figure 3 It is a comparison diagram of the change amount of the radial position of the slave axis before and after compensation using the embodiment of the present invention. Specific Embodiment

[0030] The following will describe in detail the specific embodiments of the embodiments of the present invention with reference to the accompanying drawings. It should be understood that the specific embodiments described herein are only used to illustrate and explain the embodiments of the present invention, and are not used to limit the embodiments of the present invention.

[0031] In the first aspect of the embodiment of the present invention, an autofocus motion control method is provided, as Figure 1 shown, including the following steps:

[0032] S1. In the state where the two axes of the gantry platform are released, push the gantry to collect the real-time positions of the two axes, and obtain the gantry position error of the slave axis relative to the main axis; the calculation formula of the position error is as follows:

[0033] where x represents the current position of the slave axis, x0 represents the previous position of the current position x of the slave axis, x1 represents the next position of the current position x of the slave axis, x0 < x < x1, y represents the current position error, y0 represents the position error corresponding to x0, and y1 represents the position error corresponding to x1;

[0034] Exemplarily, in the state where the two axes of the gantry platform are released, push the gantry (in fact, it can be pushed or pulled, and the important thing is that the drive of the gantry does not come from the motors of each axis. For example, the collection interval is 30 mm each time), collect the real-time positions of the two axes on both sides, record them in the memory of the flash chip, calculate the real-time position error of the slave axis Y2 relative to the main axis Y1, select the real-time position of the Y2 axis and the position error of Y2 relative to Y1 as the position compensation data of the Y2 axis, accumulate and collect n groups (it can be collected at equal intervals or at equal times, and the equipment used for collection includes but is not limited to a PC computer), and calculate the required position compensation amount at the current position of the Y2 axis using the above formula.

[0035] S2. Drive the two axes using the master command parallel control method, and at the same time update the curve planning of the slave axis with each position error as the compensation amount of the slave axis to eliminate the radial force on the double-drive gantry.

[0036] In one embodiment of the present invention, in step S2, each position error is used as the compensation amount of the slave axis to update the curve planning of the slave axis in real time. Specifically, before each curve planning, the corresponding position error is added as the compensation amount to the trajectory position of the slave axis, and the main axis is kept at the original trajectory position as the given position of the position controller. After removing the position compensation amount, it is the master command parallel control method. The two Y axes use the same three-ring control loop and have the same position given value. The position feedback is the respective sensor data (encoder position feedback or grating scale position feedback). This method is that there is no coupling between the two motor controls, and their respective movements are independent and will not affect each other. This control method cannot meet the stress state of the gantry when the motor is moving and stationary. Due to structural differences, both sides move the same distance. At this time, the gantry is not necessarily in a natural state, and may be tilted, which will produce pulling force; after adding the position compensation amount, such as Figure 1 As shown in the figure, by changing the Y2-axis position setting, the effect of moving the two sides by different distances can be achieved, so that the tilt state of the gantry at different positions can be controlled. Since the first-order interpolation method is used, the amount of calculation is small, and the two axes can still share the same set of three-loop gain parameters. The traditional cross-coupling method is quite different from the existing control loop, and an additional controller is required to control the inclination angle of the gantry. It is difficult to debug and it is not easy to find a suitable inclination angle.

[0037] For example, in the release state, the gantry is pushed to a position near 200mm. At this time, the real-time position of the Y1 axis is 199.998mm, the Y2 axis is 200.010mm, and the error of the Y2-Y1 axis is 12µm. Under normal circumstances without compensation, both the Y1 and Y2 axes will move to the 200mm position, but the gantry is not in a natural state at this time; with compensation, the Y1 axis moves normally to 200mm, and the Y2 axis moves to 200.012mm, so that the gantry is in a natural state. In this way, the movement position of the Y2 axis can be compensated in real time, keeping the gantry in a natural state at all times and reducing deformation stress.

[0038] In another embodiment of the present invention, in step S2, each position error is used as the compensation amount of the slave axis to update the curve planning of the slave axis in real time. Specifically, before each curve planning, the trajectory position is kept unchanged, and the equivalent feedback position of the slave axis is used as the feedback position of the slave axis position controller. The equivalent feedback position of the slave axis is equal to the motor end feedback position at the current moment minus the corresponding compensation amount, and the main axis remains at the original trajectory position. The machine end feedback position can be an encoder feedback position or a grating ruler feedback position. Figure 2As shown in the figure, after adding the position compensation, by changing the Y2-axis position feedback, the effect of moving both sides by different distances can be achieved. In this way, the tilt state of the gantry in different positions can be controlled. Since the first-order interpolation method is used, the calculation amount is small, and the two axes can still share the same set of three-loop gain parameters.

[0039] For example, in the release state, the gantry is pushed to a position near 200mm. At this time, the real-time position of the Y1 axis is 199.998mm, the Y2 axis is 200.010mm, and the error of the Y2-Y1 axis is 12µm. Under normal circumstances without compensation, both the Y1 and Y2 axes will move to the 200mm position, but the gantry is not in a natural state at this time; with compensation, the Y1 axis moves normally to 200mm, and the Y2 axis will also move to 200mm, but at this time the Y2 axis motor end position (encoder or grating ruler position) is at 200.012mm, so the gantry is in a natural state. In this way, the Y2 axis movement position can be compensated in real time, keeping the gantry in a natural state at all times and reducing deformation stress.

[0040] The gantry is driven by the driving method of the embodiment of the present invention and the conventional driving method of the uncompensated slave axis. The radial force of the gantry is tested before and after compensation. The test method is: after driving the gantry to a certain position, release the Y axis and check the change in the front-to-back distance of the two-side Y axis. This can be used to measure the radial force of the gantry in the locked state. The comparison of the radial position change of the Y1 slave axis before and after compensation is as follows: Figure 3 As shown, it can be seen that after compensation, the radial force has been reduced to a lower level.

[0041] Furthermore, the method also includes: obtaining the gantry position error of the slave axis relative to the main axis and saving the data, reading the data after each power-on, and then performing curve planning to drive the dual axes. This provides a strategy for compensating data without losing it during power failure, thereby avoiding data loss.

[0042] The embodiment of the present invention does not need to use a digital controller (such as a PID controller) to control the position error of the dual axes in real time, and does not need to compensate the position error to the next controller (speed loop controller, such as a speed loop PI controller). This solution directly compensates the dual-axis position compensation to the given amount or feedback amount of the slave axis position controller (such as a position P controller).

[0043] Among the current control methods of dual-axis drives, the cross-coupling control method is superior to the master-command parallel control method, and the master-command parallel control method is superior to the master-slave control method. The cross-coupling method does not distinguish between the master and slave axes, and creates the Gantray axis and the Yaw axis. The Gantray axis is the midpoint position of the dual Y axes, and the moving distance of the center point of the dual Y axes is controlled by a position loop and a speed loop controller (half of the sum of the positions of the master and slave axes is used as feedback). The Yaw axis uses the position difference between the master and slave axes as feedback, and controls the deflection angle of the Y axes on both sides by a position loop and a speed loop controller. Therefore, the cross-coupling control method needs to add an additional controller to control the errors of the two axes and compensate them to the next controller. The model is complex and the loop gain is difficult to adjust. However, considering the coupling between the two axes, it can maintain high accuracy and motion state under high speed and high acceleration conditions. The master-command parallel control method only needs to adjust the gain of a single channel, and the other channel can be reused. The model is simple and easy to adjust, but the mutual influence between the two axes is ignored. The technical solution of the present invention comprehensively considers the advantages and disadvantages of the master-command parallel control method and the cross-coupling control method. On the basis of the master-command parallel control method, the influence effect between the two axes is taken into account, and the error compensation is performed on the slave axis position. After the structural installation is completed, a set of data is collected to realize the synchronous control of the master and slave axes. A stable structural state can be achieved without adjusting the control loop gain, and the gantry is kept in a stress-free state as much as possible when stationary, thereby ensuring the life of the gantry platform. Therefore, the difference between this solution and the other two methods is as follows: on the basis of the master-command parallel control method, the compensation of the slave axis position is added to avoid the pulling force problem caused by the structural error when the master and slave axes move the same distance. The Yaw axis is simplified in the cross-coupling solution, reducing the time required to re-debug the Yaw axis position loop and speed loop controller. The two Y axes can share a set of three-loop controller parameters, simplifying the control model and making debugging simple.

[0044] Based on the same inventive concept, a second aspect of an embodiment of the present invention provides a control system for a dual-drive gantry drive, comprising:

[0045] The compensation amount acquisition module is used to push the gantry to collect the real-time position of the two axes when the two axes of the gantry platform are released, and obtain the gantry position error of the slave axis relative to the main axis;

[0046] The drive compensation module is used to drive the dual axes using the master command parallel control method, and at the same time, each position error is used as the compensation amount of the slave axis to update the curve planning of the slave axis to eliminate the radial force of the dual-drive gantry;

[0047] The compensation data storage module is based on the flash chip to realize storage and is used to store the compensation data. The compensation data is stored in the flash chip, and a part of the storage space in the flash is opened up to store the compensation data. No additional memory is needed for storage, and after the drive is powered off, the data can still be retained and can be directly read after power-on.

[0048] The compensation data update module is used for the dedicated servo host computer to update the compensation data through the communication protocol (update the data after the gantry structure is installed; after the gantry structure is disassembled and reassembled). Use a dedicated servo host computer to update the compensation data through the designed communication protocol (flash data and drive internal data are updated synchronously).

[0049] Based on the same inventive concept, a third aspect of an embodiment of the present invention provides a machine-readable storage medium, on which instructions are stored, and the instructions are used to enable a machine to execute the control method of the dual-drive gantry drive mentioned above in the present application.

[0050] Based on the same inventive concept, a fourth aspect of an embodiment of the present invention provides a processor for running a program, wherein the program, when being run, is used to execute: the control method of the dual-drive gantry drive mentioned above.

[0051] In summary, the present invention first collects the position error of the two axes when the two axes of the gantry platform are in the released state, thereby determining the relative position error of the two ends of the gantry on the two axes when the radial force of the two axes is 0, and adopts the master command parallel control method to drive the master and slave axes to move. The curve planning path of the master axis remains unchanged, and the relative position error is used as a compensation amount to compensate the curve planning of the slave axis to ensure that the movement of the gantry on the two axes follows the position path collected in the released state to eliminate the radial force of the dual-drive gantry. The above technical scheme takes into account the dual-axis coupling and adopts a simple calculation method. It does not require a complex model to couple the dual-axis position relationship, avoids complex dual-axis coupling model calculations, and improves the real-time operation of the logic; on the basis of the master command control method, the dual-axis coupling compensation strategy is combined to avoid the continuous force deformation of the gantry and improve the life of the structure, thereby realizing a high-speed and high-precision dual-axis gantry drive that can avoid the radial force of the dual-axis gantry and meet the simple and convenient model calculation.

[0052] The processor includes a kernel, and the kernel retrieves the corresponding program unit from the memory. One or more kernels can be set, and the steps of the control method of the dual-drive gantry drive are executed by adjusting the kernel parameters.

[0053] The memory may include non-permanent memory in a computer-readable medium, random access memory (RAM) and / or non-volatile memory, such as read-only memory (ROM) or flash RAM, and the memory includes at least one memory chip.

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

[0055] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, 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 processes in the flowchart and / or block diagram. 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.

[0056] 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.

[0057] 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.

[0058] In a typical configuration, a computing device includes one or more processors (CPµ), input / output interfaces, network interfaces, and memory.

[0059] The memory may include non-permanent memory in a computer-readable medium, random access memory (RAM) and / or non-volatile memory in the form of read-only memory (ROM) or flash RAM. The memory is an example of a computer-readable medium.

[0060] Computer readable media include permanent and non-permanent, removable and non-removable media that can be implemented by any method or technology to store information. Information can be computer readable instructions, data structures, program modules or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, magnetic tape magnetic disk storage or other magnetic storage devices or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined herein, computer readable media does not include temporary computer readable media (transitory media), such as modulated data signals and carrier waves.

[0061] It should also be noted that the terms "comprises," "includes," or any other variations thereof are intended to cover non-exclusive inclusion, such that a process, method, commodity, or apparatus that includes a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, commodity, or apparatus.

[0062] The above are only embodiments of the present application and are not intended to limit the present application. For those skilled in the art, the present application may have various changes and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application should be included within the scope of the claims of the present application.

Claims

1. A control method for a dual-drive gantry drive, characterized in that: The following steps are involved: When the gantry platform dual-axis is released, push the gantry to collect the real-time position of the dual-axis and obtain the gantry position error of the slave axis relative to the main axis; The master command parallel control method is used to drive the dual axes, and each position error is used as the compensation amount of the slave axis to update the curve planning of the slave axis to eliminate the radial force of the dual-drive gantry; the calculation formula of the position error is as follows: Among them, x represents the current slave axis position, x0 represents the previous position of the current slave axis position x, x1 represents the next position of the current slave axis position x, x0 < x < x1, y represents the current position error, y0 represents the corresponding position error at x0, and y1 represents the corresponding position error at x1.

2. The method according to claim 1, characterized in that: The method of using each position error as the compensation amount of the slave axis to update the curve planning of the slave axis in real time is specifically as follows: before each curve planning, the corresponding position error is added to the trajectory position of the slave axis as the compensation amount, and the main axis remains in the original trajectory position as the given position of the position controller.

3. The method according to claim 1, characterized in that The method of using each position error as the compensation amount of the slave axis to update the curve planning of the slave axis in real time is specifically as follows: before each curve planning, the trajectory position is kept unchanged, and the equivalent feedback position of the slave axis is used as the feedback position of the slave axis position controller. The equivalent feedback position of the slave axis is equal to the feedback position of the motor end at the current moment minus the corresponding compensation amount, and the main axis remains in the original trajectory position.

4. The method according to any one of claims 1 to 3, characterized in that: The method further includes: obtaining the gantry position error of the slave axis relative to the main axis and saving the data, reading the data after each power-on, and then performing curve planning to drive the dual axes.

5. The method according to claim 4, characterized in that The method directly compensates the compensation amount to the given amount or feedback amount of the slave axis position controller, does not need to use a controller to control the position error of the dual axes in real time, and does not need to compensate the compensation amount in the speed loop controller.

6. A control system for a dual-drive gantry drive, characterized in that: include: The compensation amount acquisition module is used to push the gantry to collect the real-time position of the two axes when the two axes of the gantry platform are released, and obtain the gantry position error of the slave axis relative to the main axis; The drive compensation module is used to drive the dual axes using the master command parallel control method, and at the same time, each position error is used as the compensation amount of the slave axis to update the curve planning of the slave axis to eliminate the radial force of the dual-drive gantry; the calculation formula of the position error is as follows: Among them, x represents the current slave axis position, x0 represents the previous position of the current slave axis position x, x1 represents the next position of the current slave axis position x, x0 < x < x1, y represents the current position error, y0 represents the corresponding position error at x0, and y1 represents the corresponding position error at x1.

7. The system according to claim 6, characterized in that Also includes: A compensation data storage module is implemented based on a flash chip and is used to store compensation data; The compensation data update module is used for updating the compensation data of the dedicated servo host computer through the communication protocol.

8. A machine-readable storage medium having instructions stored thereon, the instructions being used to cause a machine to execute the method according to any one of claims 1 to 5.

9. A processor, characterized in that: Used to run a program, wherein the program, when run, is used to execute: the control method of the dual-drive gantry drive as described in any one of claims 1-5.

Citation Information

Patent Citations

  • Gantry dual-driving system and error detection method thereof

    CN106272369A

  • Method and system for controlling phase deviation of master shaft and slave shaft and related components

    CN116149259A

  • Gantry double-shaft debugging method and device, electronic equipment and storage medium

    CN117008539A

  • Gantry synchronization control method and control system

    CN117008540A

  • Gantry stage orthogonality error measurement method and error compensation method

    EP2299237A2