The invention is related to positioning calibration technology of motors, and more particularly to a dynamic displacement error compensation system.
In the technical field where motors are used as displacement driving components, limited machining precision affects the accuracy of displacement positions. In modem industries where precision is becoming more and more important, a slight position error may lead to major product defects. In order to ensure the accuracy of displacement position, a number of prior technologies have been disclosed in the prior art. For example, in the Chinese Patent Publication No. 104076739A, it is disclosed that a laser interferometer is used to measure the displacement stroke of a linear motor in order to know the deviation degree at each specific position of the linear motor in its displacement stroke, and based thereon to establish an error compensation table of the linear motor, and then use the error compensation table as the basis of position calibration for the linear motor in use, thereby improving the accuracy of displacement position.
However, the technology disclosed in the above-mentioned Chinese Patent Publication No. 104076739A can only compensate and calibrate the position of a single-axis movement, and cannot compensate and calibrate the position coupling error of a dual-axes motion on a plane, and thus its application is still limited. Therefore, there is another Chinese Patent Publication No. 109709892A that provides a spatial position compensation technology for multi-axes linkage. After collecting the positional information of each axis movement, calculations are further performed through the spatial position compensation program in a computer to correct the feedback position signal of a position sensing element, and the corrected feedback position signal is fed back to a drive system to compensate based on the corrected feedback positional information. Although the above-mentioned Chinese Patent Publication No. 109709892A can be used for dynamic compensation, it requires an additional external computer device with high computing power to be able to perform calculations and correction compensation, and the cost is expensive.
Therefore, a main object of the invention is to provide a dynamic displacement error compensation system capable of achieving error compensation for two- dimensional motion or motion of more than two dimensions without being required to set up additional devices in a drive framework, which is economical and accurate.
In order to achieve the above-mentioned object, a main technical feature of a dynamic displacement error compensation system provided by the invention is that detection error information obtained based on calibration detection of a first axis and a second axis, is respectively made into a first compensation table for compensating displacement on the first axis and a second compensation table for compensating displacement on the second axis by using positional information of the first axis and the second axis as variables, and the first compensation table is stored in a first driver of a first motor device for driving a first moving element to move linearly on the first axis, and the second compensation table is stored in a second driver of a second motor device for driving a second moving element to move linearly on the second axis, and the first driver and the second driver simultaneously or successively obtain a first dynamic positional information of the first moving element on the first axis and a second dynamic positional information of the second moving element on the second axis, and then the first moving element and the second moving element are respectively displaceably compensated according to the first compensation table and the second compensation table.
Thereby, the dynamic displacement error compensation system is capable of performing dynamic displacement error compensation by using the first driver and the second driver without being required to set up additional computing devices for computing compensation. In addition to being able to reduce costs, compensation of displacement error can also be achieved for two different axial directions or more than two different axial directions.
Further, in order to enable the dynamic displacement error compensation system to be applied to the existing technology without hindrance, the dynamic displacement error compensation system can further comprise a communication unit. The communication unit is electrically connected to the first driver and the second driver, so that the first dynamic positional information obtained by the first driver can be transmitted to the second driver via the communication unit, similarly, the second dynamic positional information obtained by the second driver can also be transmitted to the first driver via the communication unit, thereby the first dynamic positional information and the second dynamic positional information obtained by the first driver and the second driver can be used to compensate motional displacement on the first axis and the second axis according to the first compensation table and the second compensation table respectively.
The objects, features, and achieved efficacies of the invention can be understood from the description and drawings of the following preferred embodiments, in which:
First of all, please refer to
Wherein the first motor device 20 is a linear motor, and is provided with a stator extending along the first axis X direction, and a rotor as the first moving element that moves in the first axis X direction. Similarly, the second motor device 30 is also a linear motor, and is provided with a stator extending along the second axis Y direction, and a rotor as the second moving element that moves in the second axis Y direction. In addition, position sensing technique such as optical ruler, magnetic ruler or other position sensing techniques used to obtain dynamic positional information of the first moving element and the second moving element, are also well-known technical contents, and are known to those having ordinary skill in the art in the technical field to which the invention pertains.
The features of the dynamic displacement error compensation system 10 which are different from the above-mentioned prior art lie in the ware and the method. Among them, as for the ware, a first driver 21 of the first motor device 20 is provided with a first dynamic error processing unit 22, and a second driver 31 of the second motor device 30 is provided with a second dynamic error processing unit 32. And a communication unit 40 is electrically connected to the first driver 21 and the second driver 31, so that the first driver 21 and the second driver 31 are capable of communicating with each other via the communication unit 40.
As for the method, as shown in
Please continue to refer to
and according to the second compensation table as Table 2, a compensation value should be given to dynamic displacement of the second moving element by the second driver 31 is −0.82 mm
After performing the above-mentioned dynamic displacement error compensation, a circular degree of 11.0 μm is obtained from circularity test results shown in
In addition, the applicant of the invention needs to provide further explanations. Although the first axis and the second axis are in a relative state of being perpendicular to each other in the above-mentioned embodiment, but they are not limited thereto, the first axis and the second axis can also be parallel to each other or in a state of perpendicularly intersecting with each other. Furthermore, the communication unit can be wireless transmission in addition to wired transmission. And, it is important that a source of the second dynamic positional information obtained by the first driver is not limited to the second driver, the position sensing mechanism can also enable both the first dynamic positional information and the second dynamic positional information to be fed back to the first driver and the second driver without being transmitted via the communication unit, which is also capable of achieving the objects and efficacies of the invention.
It is to be understood that the above description is only preferred embodiments of the present invention and is not used to limit the present invention, and changes in accordance with the concepts of the present invention may be made without departing from the spirit of the present invention, for example, the equivalent effects produced by various transformations, variations, modifications and applications made to the configurations or arrangements shall still fall within the scope covered by the appended claims of the present invention.
Number | Name | Date | Kind |
---|---|---|---|
20190337106 | Nakamura | Nov 2019 | A1 |
Number | Date | Country |
---|---|---|
S62226206 | Oct 1987 | JP |
H0740163 | Feb 1995 | JP |
2007142093 | Jun 2007 | JP |
Number | Date | Country | |
---|---|---|---|
20220307869 A1 | Sep 2022 | US |