The invention relates to a rotor displacement measuring device for a planar motor including the sine magnetic field model and the like, and its measuring method, particularly to a subdivision displacement measuring device and computing method with relatively a long moving range and high resolution.
In the two-dimensional positioning and machining devices, especially the modern semiconductor micromachining equipments, and other ultra-precision machining equipments, the high-precise movement is typically implemented by the planar motor. The planar motor has attracted much attention in both the academe and the industry because of its advantages such as its quick response, high sensitivity and simple structure. Chinese Patents No. 201110045692.8, No. 200910029368.X and No. 200910088894.3 have described several types of planar motors with different structures in detail.
Currently, the detection for the rotor position of the planar motor is usually performed by the optical measurement method such as using the grating and the laser interferometer. According to Chinese Patent No. 200880111964.6, the movement measurement for the planar motor is performed with a two-dimensional grating, in which a planar grating of a larger area is required to be installed in the planar motor so as to generate optical signals with displacement information to communicate with optical sensors, and the requirement for operating environment is higher, and the surfaces of the grating ruler must be protected and prevented from being polluted; according to Chinese Patent No. 201110040403.5, the grating sensor is adopted to detect the moving position in two directions, and in each direction, a main scale and its corresponding reading head, which must meet the measuring range requirement, are required to be installed to generate Moire fringe signals or other types of optical signals with the displacement information, and the requirement for operating environment is also high; and according to Chinese Patent No. 200910029828.9, a laser position sensor is adopted to perform measurement for movement of the planar motor through laser triangulation methods or echo analysis, but the preciseness of the measurement is strongly affected by the environment, and it is difficult to guarantee high preciseness under long moving range and the signal processing is not simple and quick at the same time.
Therefore, it is desirable to develop a newly planar motor rotor displacement measuring method, which has advantages of reducing complexity of installation of the sensor, having high preciseness under long moving range and simple and quick signal processing.
The present invention aims to provide a planar motor rotor displacement measuring device and measuring method thereof, which provides highly precise displacement measurement of the motor's rotor in a long moving range in a plane in two degrees-of-freedom, and can directly output orthogonal coding signals commonly used in the industry.
In order to achieve the above object, the present invention provides the following technical solution:
A planar motor rotor displacement measuring device, where the planar motor is a moving-coil type planar motor comprising a stator and a rotor on the stator, the stator includes a magnetic steel array, and a coil array is arranged on the lower surface of the rotor; the displacement measuring device comprises a probe, two sets of sine sensors, two sets of cosine sensors, a signal lead wire and a signal processing circuit; the probe is arranged at the edge of the rotor which is located in the sine magnetic field area generated by the magnetic steel array of the stator of the moving-coil type planar motor; the two sets of sine sensors include an x-direction sine sensor set and a y-direction sine sensor set, the two sets of cosine sensors include an x-direction cosine sensor set and a y-direction cosine sensor set; the sensors are arranged in the probe in such a manner, firstly, one sensor is arranged in the probe as the reference sensor, my sensors in total including the reference sensor are uniformly arranged within a magnetic field pitch τ along the x-direction, forming the y-direction sine sensor set; taking the reference sensor as the first sensor, mx sensors in total including the reference sensor are uniformly arranged within a magnetic field pitch τ along the y-direction, forming the x-direction sine sensor set; beginning at the distance τ/4 from the reference sensor in the y-direction, my sensors are uniformly arranged within a magnetic field pitch τ along the x-direction, forming the y-direction cosine sensor set; beginning at the distance τ/4 from the reference sensor in the x-direction, mx sensors are uniformly arranged within a magnetic field pitch τ along the y-direction, forming the x-direction cosine sensor set, where mx=2,3,4, . . . , my=2,3,4, . . . ; the signal processing circuit is connected with the output of the probe via the signal lead wire; the signal processing circuit includes an analog signal processing unit and a digital signal processing unit; and the magnetic field pitch τ is the spatial period of the sine magnetic field of the planar motor.
A moving-coil type planar motor rotor displacement measuring method, the method includes:
1) sampled signals of the x-direction sine sensor set, sampled signals of the x-direction cosine sensor set, sampled signals of the y-direction sine sensor set and sampled signals of the y-direction cosine sensor set are processed by the analog signal processing unit of the signal processing circuit, so as to obtain the x-direction sine measurement signal SX0, the x-direction cosine measurement signal CX0, the y-direction sine measurement signal SY0 and the y-direction cosine measurement signal CY0 respectively;
2) the x-direction sine measurement signal SX0 and the x-direction cosine measurement signal CX0 are processed with nX frequency multiplication operations by the digital signal processing unit of the signal processing circuit so as to obtain the x-direction sine subdivision signal SXn
where SX1, CX1, SX2, CX2, . . . , SX,n
also, the y-direction sine measurement signal SY0 and the y-direction cosine measurement signal CY0 are processed with nY frequency multiplication operations by the signal processing circuit so as to obtain the y-direction sine subdivision signal SYn
where SY1, CY1, SY2, CY2 . . . SY,n
3) the zero-crossing points of the x-direction sine subdivision signal SXn
4) if the x-direction sine subdivision signal SXn
5) if the y-direction sine subdivision signal SYn
6) the pulse numbers of the x-direction sine pulse signal AX or the x-direction cosine pulse signal BX obtained at step 3) are counted by the digital signal processing unit of the signal processing circuit, and the phase difference between the x-direction sine pulse signal AX and the x-direction cosine pulse signal BX is detected; taking one pulse of the x-direction sine pulse signal AX or the x-direction cosine pulse signal BX as an x-direction displacement resolution
nX=1,2,3, . . . , if the phase of the x-direction sine pulse signal AX is behind the phase of the x-direction cosine pulse signal BX, then it indicates that it is the forward displacement; and if the phase of the x-direction sine pulse signal AX is ahead of the phase of the x-direction cosine pulse signal BX, then it indicates that it is the backward displacement, in such a way, the x-direction displacement of the rotor of the planar motor is measured;
7) the pulse numbers of the y-direction sine pulse signal AY or the y-direction cosine pulse signal BY obtained at step 3) are counted by the digital signal processing unit of the signal processing circuit, and the phase difference between the y-direction sine pulse signal AY and the y-direction cosine pulse signal BY is detected; taking one pulse of the y-direction sine pulse signal AY or the y-direction cosine pulse signal BY as a y-direction displacement resolution
nY=1,2,3, . . . , if the phase of the y-direction sine pulse signal AY is behind the phase of the y-direction cosine pulse signal BY, then it indicates that it is the forward displacement; and if the phase of the y-direction sine pulse signal AY is ahead of the phase of the y-direction cosine pulse signal BY, then it indicates that it is the backward displacement, in such a way, the y-direction displacement of the rotor of the planar motor is measured.
The invention is characterized in that, nX can be determined as follows:
given that the BXM is the magnitude of the magnetic induction intensity along the x-direction of the sine magnetic field generated by the magnetic steel array of the stator of the planar motor, and vx is the noise in the sensor measurement along the x-direction, then the maximized number of times of frequency multiplication operations along the x-direction is
nY described at step 2) can be determined as follows:
Compared with the prior art, the invention has the following advantages: The method only involves simple subtraction and multiplication to derive the displacement information contained in the magnetic field signals and it directly utilize the sine magnetic field of the motor itself without need of solving non-linear equations, which makes the calculation simple and quick; and for the device, it doesn't need to configure the components for generating the signals containing displacement information, which can lower the production cost significantly; and when increasing the moving range, it only needs to increase the dimension of the stator and doesn't affect the resolution for the displacement, which may achieve the planar motor rotor displacement measurement of long moving range and high precision.
a and 3b are waveform schematic views of the x-direction sine and cosine measurement signals, x-direction sine and cosine subdivision signals and x-direction sine and cosine pulse signals when nx=4 according to the present invention.
a and 4b are schematic views of two sets of orthogonal pulse signals of the rotor displacement during the measurement according to the present invention.
The main numerals used in the drawings are:
In the following, the embodiments of the invention will be further described in detail in conjunction with the accompanying drawings.
Referring to
Referring to
Referring to
The planar motor rotor displacement measuring method described in the invention includes the following steps:
1) sampled signals of the x-direction sine sensor set, sampled signals of the x-direction cosine sensor set, sampled signals of the y-direction sine sensor set and sampled signals of the y-direction cosine sensor set are processed by the analog signal processing unit of the signal processing circuit, so as to obtain the x-direction sine measurement signal SX0, the x-direction cosine measurement signal CX0, the y-direction sine measurement signal SY0 and the y-direction cosine measurement signal CY0 respectively;
2) the x-direction sine measurement signal SX0 and the x-direction cosine measurement signal CX0 are processed with nX frequency multiplication operations by the digital signal processing unit of the signal processing circuit so as obtain the x-direction sine subdivision signal SXn
where SX1, CX1, SX2, Cx2, . . . , SX,n
also, the y-direction sine measurement signal SY0 and the y-direction cosine measurement signal CY0 are processed with nY frequency multiplication operations by the signal processing circuit so as to obtain the y-direction sine subdivision signal SYn
where SY1, CY1, SY2, CY2, . . . , SY,n
3) the zero-crossing points of the x-direction sine subdivision signal SXn
4) if the x-direction sine subdivision signal SXn
5) if the y-direction sine subdivision signal SYn
6) the pulse numbers of the x-direction sine pulse signal AX or the x-direction cosine pulse signal BX obtained at step 3) are counted by the digital signal processing unit of the signal processing circuit, and the phase difference between the x-direction sine pulse signal AX and the x-direction cosine pulse signal BX is detected; taking one pulse of the x-direction sine pulse signal AX or the x-direction cosine pulse signal BX as an x-direction displacement resolution
where nX=1,2,3, . . . ; if the phase of the x-direction sine pulse signal AX is behind the phase of the x-direction cosine pulse signal BX, then it indicates that it is the forward displacement; if the phase of the x-direction sine pulse signal AX is ahead of the phase of the x-direction cosine pulse signal BX, then it indicates that it is the backward displacement, in such a way, the x-direction displacement of the rotor of the planar motor is measured;
7) the pulse numbers of the y-direction sine pulse signal AY or the y-direction cosine pulse signal BY obtained at step 3) are counted by the digital signal processing unit of the signal processing circuit, and the phase difference between the y-direction sine pulse signal AY and the y-direction cosine pulse signal BY is detected; taking one pulse of the y-direction sine pulse signal AY or the y-direction cosine pulse signal BY as an y-direction displacement resolution
nY=1,2,3, . . . ; if the phase of the y-direction sine pulse signal AY is behind the phase of the y-direction cosine pulse signal BY, then it indicates that it is the forward displacement; if the phase of the y-direction sine pulse signal AY is ahead of the phase of the y-direction cosine pulse signal BY, then it indicates that it is the backward displacement, in such a way, the y-direction displacement of the rotor of the planar motor is measured.
nX described at step 2) can be determined as follows:
given that the BXM is the magnitude of the magnetic induction intensity along the x-direction of the sine magnetic field generated by the magnetic steel array of the stator of the planar motor, and vx is the noise in the sensor measurement noise along the x-direction, then the maximized number of times of frequency multiplication operations along the x-direction is
nY described at step 2) can be determined as follows:
given that the BYM is the magnitude of the magnetic induction intensity along the y-direction of the sine magnetic field generated by the magnetic steel array of the stator of the planar motor, and vy is the noise in the sensor measurement along the y-direction, then the maximized number of times of frequency multiplication operations along the y-direction is
The embodiment:
for example, mx=my=4, the magnetic field pitch τ=35.35 mm, according to the formula of the maximized number of times of frequency multiplication operations, taking nX=nY=4, the device and method of the invention are implemented.
The device can be seen from
The method includes:
1) sampled signals of the x-direction sine sensor set, sampled signals of the x-direction cosine sensor set, sampled signals of the y-direction sine sensor set and sampled signals of the y-direction cosine sensor set are processed by the analog signal processing unit of the signal processing circuit, so as to obtain the x-direction sine measurement signal SX0, the x-direction cosine measurement signal CX0, the y-direction sine measurement signal SY0 and the y-direction cosine measurement signal CY0 respectively;
2) the x-direction sine measurement signal SX0 and the x-direction cosine measurement signal CXO are processed with nX=4 frequency multiplication operations, i.e. 24 subdivision operations by the digital signal processing unit of the signal processing circuit:
S
X1=2*SX0*CX0,CX1=CX0*−CX0−SX0*SX0,
S
X2=2*SX1*CX1,CX2=CX1*−CX1−SX1*SX1,
S
X3=2*SX2*CX2,CX3=CX2*−CX2−SX2*SX2,
S
X4=2*SX3*CX3,CX4=CX3*−CX3−SX3*SX3,
so as to obtain the x-direction sine subdivision signal SX4 and the x-direction cosine subdivision signal CX4, where SX1, CX1, SX2, CX2, SX3 and CX3 are intermediate variables, also, the y-direction sine measurement signal SY0 and the y-direction cosine measurement signal CY0 are processed with nY=4 frequency multiplication operations, i.e. 24 subdivision operations by the signal processing circuit:
S
Y1=2*SY0*CY0,CY1=CY0*CY0−SY0*SY0,
S
Y2=2*SY1*CY1,CY2=CY1*CY1−SY1*SY1,
S
Y3=2*SY2*CY2,CY3=CY2*CY2−SY2*SY2,
S
Y4=2*SY3*CY3,CY4=CY3*CY3−SY3*SY3,
so as to obtain the y-direction sine subdivision signal SY4 and the y-direction cosine subdivision signal CY4, where SY1, CY1, SY2, CY2, SY3 and CY3 are intermediate variables;
3) The zero-crossing points of the x-direction sine subdivision signal SX8 and the x-direction cosine subdivision signal CX8 are detected by the digital signal processing unit of the signal processing circuit respectively, generating a set of x-direction orthogonal pulse signals, that is, the x-direction sine pulse signal AX and x-direction cosine pulse signal BX; also, the zero-crossing points of the y-direction sine subdivision signal SY8 and the y-direction cosine subdivision signal CY8 are detected respectively, generating a set of y-direction orthogonal pulse signals, that is, the y-direction sine pulse signal AY and y-direction cosine pulse signal BY;
4) referring to
5) if the y-direction sine subdivision signal SY8>0, then the output of the y-direction sine pulse signal AY is of high level; if the y-direction sine subdivision signal SY8<0, then the output of the y-direction sine pulse signal AY is of low level; if the y-direction sine subdivision signal SY8=0, then the output of the y-direction sine pulse signal AY remains unchanged; and if the y-direction cosine subdivision signal CY8>0, then the output of the y-direction cosine pulse signal BY is of high level; if the y-direction cosine subdivision signal CY8<0, then the output of the y-direction cosine pulse signal BY is of low level; if the y-direction cosine subdivision signal CY8=0, then the output of the y-direction cosine pulse signal BY remains unchanged;
6) referring to
and the phase of the x-direction sine pulse signal AX is ahead of the phase of the x-direction cosine pulse signal BX, indicating the backward displacement, so in
referring to
and the phase of the y-direction sine pulse signal AY is behind the phase of the y-direction cosine pulse signal BY, indicating the forward displacement, so in
Through the above steps, on condition that the zero-crossing points are able to be detected, it only requires simple subtraction and multiplication to extract the displacement information contained in the magnetic field signals, and differently from the prior art, the components configured for generating signals containing the displacement information are not required, simplifying the installation of hardware and reducing the cost, and at the same time, the displacement measurement of the rotor of the planar motor of long moving range and high preciseness is still guaranteed.
Only some preferred embodiments of the present invention are described in the above. Without departing from the scope of the invention disclosed in the claims, various modification, addition and substitution should be considered as in the scope of protection of the invention.
Number | Date | Country | Kind |
---|---|---|---|
201210038659.7 | Feb 2012 | CN | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2013/071580 | 2/8/2013 | WO | 00 |