The present invention relates to an apparatus and method for detecting a multi-turn absolute rotation angle, and more particularly, to an apparatus and method for detecting a multi-turn absolute rotation angle by detecting angles within one rotation of plural rotating shafts differing in transmission gear ratio.
It is necessary to control axial rotation of a rotational drive source such as a motor over multiple rotations in order to control positions of machine tools or mobile bodies such as robots. In particular, it is extremely important to detect angles within one rotation at high resolution and obtain angle information over a larger number of rotations. However, a large number of rotation angle detection apparatus with increased resolution as well as with angle information for an increased number of rotations have been proposed conventionally.
To deal with the problems of increases in the number of angle detectors, complication of a gear mechanism, and increases in the size of the gear mechanism when using two angle detectors differing in a shaft angle multiplier for angle detection of one axis in order to increase detection resolution within one rotation and increase a multi-turn detection range, an absolute position detection method disclosed in Japanese Patent No. 3665732 proposes a method which quadruples the resolution without decreasing the multi-turn detection range and without increasing the number of resolvers by using a 4-fold angle resolver for a first axis and a 1-fold angle resolver for a second axis.
Conventional detection methods have a problem in that particular accuracy is required of the first, first-stage absolute position detector (resolver) RS1, which is used for both region discrimination within one rotation and the number of rotations as described in Paragraph [0006] of Patent Literature 2. That is, the region discrimination within one rotation and discrimination of the number of rotations described in Patent Literature 1 are performed based on waveforms shown in
In the configuration according to Patent Literature 1, three 1-fold angle resolvers RS1, RS2, and RS3 are used, and nearly four times higher accuracy is required of one resolver than the other resolvers. Thus, either a high-accuracy resolver is used only for RS1 or resolvers with equal accuracy are used for RS1, RS2, and RS3 by applying a narrowed detection range to RS2 and RS3 instead of using rotation cycles originally expected of RS2 and RS3. It is difficult in many cases to use a particularly high-accuracy angle detector only for RS1 due to limitations of installation space or due to design or manufacturing constraints. Also, from the perspective of standardizing parts, it is preferable in many cases to use 1-fold angle resolvers with equal accuracy for RS1 to RS3.
Patent Literature 2 discloses an encoder having four angle detection axes as with Patent Literature 1, wherein a gear G0 and a gear G1 are connected at a gear ratio of one to one and a 1-fold angle detector for the gear G1 is used only for region discrimination of a 4-fold angle detector for the gear G0. Whereas Patent Literature 1 obtains a detection range of 20,368 rotations from three signals of a 26-rotation cycle, 27-rotation cycle, and 29-rotation cycle, Patent Literature 2 mechanically obtains a detection range of only 783 rotations from 27 rotations per cycle and 29 rotations per cycle.
The discrimination based on signal waveforms of
The present invention has been made to solve the above problem and provides a multi-turn rotation angle detection apparatus comprising: a main shaft gear mounted on a main shaft; a first counter-shaft gear and second counter-shaft gear adapted to mesh with the main shaft; a first counter-shaft and second counter-shaft adapted to transmit rotations of the first and second counter-shaft gears, respectively; a set of angle detectors including a main shaft angle detector adapted to detect a rotation angle of the main shaft and first and second counter-shaft angle detectors adapted to detect rotation angles of the first and second counter-shafts, where the main shaft angle detector outputs N cycles of an N-fold angle detection value P0(NX) per rotation of the main shaft and the first and second counter-shaft angle detectors output one cycle of 1-fold angle detection values P1(1X) and P2(1X), respectively, per rotation of the respective counter-shafts; and a gear mechanism having a teeth number difference of two or a larger integer a between the first counter-shaft gear and the main shaft gear, and a teeth number difference of 1 between the second counter-shaft gear and the main shaft gear, the number of teeth of the first counter-shaft gear being an integral multiple of a product of the teeth number difference a and a shaft angle multiplier N of the angle detector attached to the main shaft, wherein a multi-turn absolute rotation angle of the main shaft is determined from rotation angle detection values of the main shaft, the first counter-shaft, and the second counter-shaft, the multi-turn rotation angle detection apparatus further comprising main shaft rotation angle detection means adapted to determine a signal P0((aN/M)×X) one cycle of which corresponds to M/aN rotations of the main shaft from the N-fold angle detection value P0(NX) detected by the main shaft angle detector and the 1-fold angle detection value P1(1X) of the first counter-shaft detected by the first counter-shaft angle detector, M being the number of teeth of the first counter-shaft, obtain a discrimination value which indicates to which cycle of the N cycles the N-fold angle detection value P0(NX) detected by the main shaft angle detector belongs from the signal P0((aN/M)×X), and synthesize one cycle of a 1-fold angle detection value P0(1X) of the main shaft per rotation of the main shaft from the discrimination value and the N-fold angle detection value P0(NX), and main shaft rotation count detection means adapted to generate a first counter-shaft periodic signal which represents a difference in rotation count between the main shaft and the first counter-shaft, from the 1-fold angle detection value P0(1X) of the main shaft and the 1-fold angle detection value P1(1X) of the first counter-shaft, generate a second counter-shaft periodic signal which represents a difference in rotation count between the main shaft and the second counter-shaft, from the 1-fold angle detection value P0(1X) of the main shaft and the 1-fold angle detection value P2(1X) of the second counter-shaft detected by the second counter-shaft angle detector, and determine the rotation count of the main shaft from the first counter-shaft periodic signal and the second counter-shaft periodic signal.
Also, the present invention provides a multi-turn rotation angle detection apparatus further comprising a third counter-shaft in addition to the first counter-shaft and the second counter-shaft, wherein there is a teeth number difference of 1 between the main shaft gear and the third counter-shaft; a third counter-shaft periodic signal which represents a difference in rotation count between the main shaft and the third counter-shaft is generated from the 1-fold angle detection value P0(1X) of the main shaft and a 1-fold angle detection value P3(1X) of the second counter-shaft detected by the third counter-shaft angle detector; and the main shaft rotation count detection means determines the rotation count of the main shaft from the first counter-shaft periodic signal, the second counter-shaft periodic signal, and the third counter-shaft periodic signal.
Furthermore, the present invention provides a multi-turn rotation angle detection method for a multi-turn rotation angle detection apparatus which comprises a main shaft gear mounted on a main shaft which transmits rotation of a rotational drive source, a first counter-shaft gear and second counter-shaft gear adapted to mesh with the main shaft, a first counter-shaft and second counter-shaft adapted to transmit rotations of the first and second counter-shaft gears, respectively, a set of angle detectors including a main shaft angle detector adapted to detect a rotation angle of the main shaft and first and second counter-shaft angle detectors adapted to detect rotation angles of the first and second counter-shafts, where the main shaft angle detector outputs N cycles of an N-fold angle detection value P0(NX) per rotation of the main shaft and the first and second counter-shaft angle detectors output one cycle of 1-fold angle detection values P1(1X) and P2(1X), respectively, per rotation of the respective counter-shafts, and a gear mechanism having a teeth number difference of two or a larger integer a between the first counter-shaft gear and the main shaft gear, and a teeth number difference of 1 between the second counter-shaft gear and the main shaft gear, the number of teeth of the first counter-shaft gear being an integral multiple of a product of the teeth number difference a and a shaft angle multiplier N of the angle detector attached to the main shaft, wherein a multi-turn absolute rotation angle of the main shaft is determined from rotation angle detection values of the main shaft, the first counter-shaft, and the second counter-shaft, the multi-turn rotation angle detection method comprising a step of detecting N cycles of an N-fold angle detection value P0(NX) per rotation of the main shaft, which is the rotation angle of the main shaft, and detecting one cycle of 1-fold angle detection values P1(1X) and P2(1X) per rotation of the respective counter-shafts, which are the rotation angles of the first and second counter-shafts, respectively; step of determining a signal P0((aN/M)×X) one cycle of which corresponds to M/aN rotations of the main shaft from the N-fold angle detection value P0(NX) detected by the main shaft angle detector and the 1-fold angle detection value P1(1X) of the first counter-shaft detected by the first counter-shaft angle detector, where M is the number of teeth of the first counter-shaft, obtaining a discrimination value which identifies to which cycle of the N cycles the N-fold angle detection value P0(NX) detected by the main shaft angle detector belongs from the signal P0((aN/M)×X), and thereby determining a rotation angle within one rotation of the main shaft; and a step of synthesizing one cycle of a 1-fold angle detection value P0(1X) of the main shaft per rotation of the main shaft from the discrimination value and the N-fold angle detection value P0(NX), generating a first counter-shaft periodic signal which represents a difference in rotation count between the main shaft and the first counter-shaft, from the 1-fold angle detection value P0(1X) of the main shaft and the 1-fold angle detection value P1(1X) of the first counter-shaft, generating a second counter-shaft periodic signal which represents a difference in rotation count between the main shaft and the second counter-shaft, from the 1-fold angle detection value P0(1X) of the main shaft and the 1-fold angle detection value P2(1X) of the second counter-shaft detected by the second counter-shaft angle detector, and determining the rotation count of the main shaft from the first counter-shaft periodic signal and the second counter-shaft periodic signal.
Furthermore, the present invention provides a multi-turn rotation angle detection method, wherein: the multi-turn rotation angle detection apparatus further comprises a third counter-shaft in addition to the first counter-shaft and the second counter-shaft; there is a teeth number difference of 1 between the main shaft gear and the third counter-shaft; the multi-turn rotation angle detection method further comprises a step of generating a third counter-shaft periodic signal which represents a difference in rotation count between the main shaft and the third counter-shaft from the 1-fold angle detection value P0(1X) of the main shaft and a 1-fold angle detection value P3(1X) of the second counter-shaft detected by the third counter-shaft angle detector; and the step of determining the rotation count of the main shaft further includes a step of determining the rotation count of the main shaft from the first counter-shaft periodic signal, the second counter-shaft periodic signal, and the third counter-shaft periodic signal.
The present invention can obtain a multi-turn detection range by making full use of the accuracies of individual angle detectors when an N-fold angle detector adopted to output N cycles of a detection signal per rotation is used for the main shaft and 1-fold angle detectors are used for the counter-shafts without requiring the 1-fold angle detector of the first counter-shaft to have particularly high accuracy compared to the 1-fold angle detectors of the second and subsequent counter-shafts to obtain detection resolution within one rotation and even when angle detectors of equal accuracy are used. Also, the present invention makes it possible to easily derive region discrimination and the number of rotations in relation to detection values of the main shaft. Furthermore, the present invention allows the number of gears used for the main shaft to be reduced.
A rotation angle detection apparatus according to the present invention is intended to improve detection resolution of a multi-turn absolute rotation angle and widen a multi-turn detection range. Although the following embodiment will be described assuming that the rotation angle detection apparatus is made up of gears having specific numbers of teeth, the numerical values may be changed without departing from the spirit of the present invention.
The main shaft gear 10b is meshed with first to third counter-shaft gears 11b, 12b, and 13b, whose rotations are transmitted to first to third counter-shafts 11a, 12a, and 13a, respectively. The numbers of teeth M, Q, and S of the first to third counter-shaft gears 11b, 12b, and 13b are 32, 27, and 29, respectively. Rotation angles θ0 to θ3 of the first to third counter-shafts 11a, 12a, and 13a are detected by resolvers RS1 to RS3 attached to the first to third counter-shafts 11a, 12a, and 13a. As with the resolver RS0, resolvers RS1 to RS3 output angle detection (value) signals corresponding to rotation angles between 0 and 360 degrees. The resolvers RS1 to RS3 are 1-fold (1X) angle detectors each of which outputs one cycle of a signal each time the respective counter-shafts performs one rotation, and an angle detector other than a resolver may be used.
If a is an integer equal to or larger than 2, the number of teeth R of the main shaft gear 10b and the numbers of teeth M, Q, and S of the first to third counter-shaft gears 11b, 12b, and 13b satisfy
M=R±a,Q=R±1,S=R∓1 [Mathematical expression 1]
where if k is an integer equal to or larger than 1 and N is an integer equal to or larger than 2, the number of teeth M of the first counter-shaft gear can be selected so as to satisfy M=k×a×N. In the present embodiment, R=28, Q=27, S=29, a=4, N=4, k=2, and M=32 are selected.
In the rotation angle detection apparatus 1 shown in
Based on the above relationships, each time the main shaft 10a performs 8 rotations, one cycle of a periodic signal can be calculated from the detection signals of the resolvers RS0 and RS1 adapted to detect the respective rotation angles of the main shaft 10a and first counter-shaft 11a, each time the main shaft 10a performs 27 rotations, one cycle of a periodic signal can be calculated from the detection signal of the resolver RS0 and the detection signal of the resolver RS2 adapted to detect the rotation angle of the second counter-shaft 12a, and each time the main shaft 10a performs 29 rotations, one cycle of a periodic signal can be calculated from the detection signal of the resolver RS0 and the detection signal of the resolver RS3 adapted to detect the rotation angle of the third counter-shaft 12a. Finally, the multi-turn absolute rotation angle of the main shaft 10a can be determined from the values of the three periodic signals. A range of rotation angles in which the multi-turn absolute rotation angle can be determined is 6264 (8×27×29), which is the least common multiple of the three cycles, and consequently, the multi-turn absolute rotation angle of the main shaft 10a can be determined over the range in which the main shaft 10a performs 6264 rotations. A calculation method for determining the multi-turn absolute rotation angle θc of the main shaft 10a from the detection signal values of the resolvers RS0 to RS3 will be described below.
After going through the above processes, the detection values P0(4X), P1(1X), P2(1X), and P3(1X) are sent to a multi-turn computation circuit 25.
Upon receiving the detection values P0(4X), P1(1X), P2(1X), and P3(1X) shown in
[Mathematical expression 2]
P
0(NX)=mod(N×θ0,u) (1)
In the following calculation formulae, mod(x, a) represents a remainder computation for finding the remainder by dividing x by a, the numerical value N represents the value of an angle multiplication factor (4 according to the present embodiment) of the angle detector RS0, and u represents the basic unit quantity per rotation of (360° according to the present embodiment) the rotating shaft.
Next, since the first to third counter-shafts 11a, 12a, and 13a are meshed with the main shaft gear 10b, the multi-turn angles θ1, θ2, and θ3 of the first to third counter-shafts 11a, 12a, and 13a are given by Eqs. (2) to (4) below. Note that the minus sign attached to the head of each equation indicates that the given counter-shaft rotates in a direction opposite the main shaft.
Since the multi-turn angles θ1, θ2, and θ3 of the first to third counter-shafts 11a, 12a, and 13a are given by Eqs. (2) to (4), the detection values P1(1X), P2(1X), and P3(1X) of the rotation angles of the first to third counter-shafts, which are detected by 1-fold angle detectors and which are equal to the remainders obtained by dividing the multi-turn angles of the respective counter-shafts by the basic unit quantity u, are given by Eqs. (5) to (7) below.
Note that as described above, the numbers of teeth of the first to third counter-shafts 11a, 12a, and 13a are M=32, Q=27, and S=29, respectively, according to the present embodiment.
Since the angle detector RS0 attached to the main shaft is an N-fold angle detector which outputs an N-cycle signal each time the main shaft 10a performs one rotation, as shown by the 4-fold angle waveform in Part (a) of
A discrimination value is generated as follows using a difference in the amount of rotation between the main shaft and first counter-shaft. Since the detection value of the main shaft is an N-fold angle and the detection value of the first counter-shaft is a 1-fold angle, the detection value of the difference in the amount of rotation cannot be calculated as it is. Thus, first, an N-fold angle detection value P1(NX) is generated from the detection value of the 1-fold angle detector by finding a remainder obtained by multiplying the detection value P1(1X) of the first counter-shaft by N and dividing the product by the basic unit quantity u, as shown in Eq. (8) below.
In relation to the rotation count of the main shaft, a 4-fold angle detection value P1(4X) of the first counter-shaft has a waveform shown in Part (b) of
Next, a difference between the detection values of the main shaft and first counter-shaft is determined. According to the present embodiment, since the rotation of the counter-shafts is treated as negative when the rotation of the main shaft is taken as positive, the difference can be found by addition. Since mod(a, c)+mod(b, c)=mod(a+b, c) holds in remainder calculation, when the N-fold angle detection value P1(NX) of the first counter-shaft is determined, a periodic signal of M/aN rotations is obtained by adding the detection value PO(NX) of the main shaft to the detection value P1(NX) as shown in Eq. (9) below. Thus, from the sum of the N-fold angle detection values of the main shaft and first counter-shaft, one cycle of a periodic signal P0((aN/M)×X) is obtained each time the main shaft performs M/aN rotations.
A waveform of the periodic signal of Eq. (9) is shown in Part (c) of
The periodic signal shown in Part (c) of
Furthermore, as described below, a signal of a stepped waveform may be generated from the periodic signals in Parts (a) and (c) of
When the numerical values a=4, N=4, M=32, u=360 selected in the present embodiment are substituted into Eq. (10), Eq. (10) presents a stepped waveform R(0-7) with (M/a−1) steps (seven steps according to the present embodiment) as shown in Part (a) of
A stepped waveform R0′ with (N−1) steps can be generated by performing the process of Eq. (11) below for finding a remainder by dividing the stepped waveform R0 by N, the stepped waveform R0 being determined using Eq. (10).
[Mathematical expression 12]
R
0′=mod(R0,N) (11)
When N=4 is substituted into Eq. (11), Eq. (11) presents a stepped waveform R(0-3)′ with three steps (N−1 steps) as shown in Part (b) of
Next, generation of a periodic signal for each counter-shaft in relation to the main shaft will be described. The periodic signal represents a difference in the rotation angle between the main shaft and counter-shaft. In other words, the main shaft gear and counter-shaft gear mesh with each other at the same position every cycle of the periodic signal. By taking the gear position of the main shaft and the counter-shaft at a certain time point as an initial position (position where the rotation count of the main shaft is indicated as 0),
First, to obtain a periodic signal, it is necessary to use detection values outputted from angle detectors of the same multiplication factor. According to the present embodiment, since the angle detectors of the counter-shafts are 1-fold angle detectors, the detection value obtained from the angle detector of the main shaft needs to be converted into a 1-fold angle detection value. Thus, the 1-fold angle detection value P0(1X) of the main shaft is synthesized by Eq. (12) below using the N-fold angle detection value P0(NX) of the main shaft and Eq. (11) above.
When the numerical values a=4, N=4, M=32, u=360 selected in the present embodiment are substituted into the 1-fold angle detection value P0(1X) of the main shaft synthesized using Eq. (12), a sawtooth-shaped waveform is obtained, where the waveform performs one cycle, increasing monotonically each time the main shaft performs a rotation as shown in Part (c) of
Once the 1-fold angle detection value P0(1X) of the main shaft is synthesized, the 1-fold angle detection value P0(1X) of the main shaft and the detection value P1(1X) of the first counter-shaft are added together as shown in Eq. (13) below to obtain one cycle of the periodic signal of the first counter-shaft each time the main shaft performs M/a rotations.
Note that mod(a, c)+mod(b, c)=mod(a+b, c) holds in remainder calculation. When the numerical values a=4, M=32, u=360 according to the present embodiment are substituted into Eq. (13), one cycle of the periodic signal is obtained each time the main shaft performs eight rotations as shown in Part (a) of
Also, when the detection value P2(1X) of the second counter-shaft is added to the 1-fold angle detection value P0(1X) of the main shaft, one cycle of the periodic signal of the second counter-shaft is obtained each time the main shaft performs Q rotations as shown in Eq. (14) below. According to the present embodiment, one cycle of the periodic signal of the second counter-shaft is obtained each time the main shaft performs 27 rotations as shown in Part (b) of
Once the periodic signals of all the counter-shafts are obtained, the relative rotation counts of the counter-shaft gears are calculated next. Since the number of rotations per cycle of the periodic signal of each counter-shaft is known, the relative rotation count is obtained by multiplying the ratio of the periodic signal value to the basic unit quantity u by the number of rotations per cycle. Eqs. (16), (17), and (18) below are used to calculate the relative rotation counts m1 to m3 of the first to third counter-shaft gears.
If relationships between a multi-turn rotation count n of the main shaft and the relative rotation counts m1 to m3 of the counter-shafts are calculated beforehand and stored as a lookup table in a storage device (such as a ROM) as shown in
The multi-turn absolute rotation angle of the main shaft can be found by adding together the multi-turn rotation count of the main shaft and rotation angle within one rotation of the main shaft. The rotation angle within one rotation of the main shaft can be found by applying region discrimination to an output signal P0(4X) from the 4-fold angle detector RS0 of the main shaft. Alternatively, the rotation angle may be found from the detection value P0(1X) of the main shaft synthesized into a 1-fold angle detection value shown in Part (c) of
Next, with reference to a flowchart shown in
Once the detection values of the main shaft and counter-shafts are detected, the flow goes to step 82, where the 1-fold angle detection value P1(1X) of the first counter-shaft is converted into a 4-fold angle detection value P1(4X) according to Eq. (8) to discriminate to which discrimination region within one rotation of the main shaft the angle detection value P0(NX) of the main shaft belongs. Next, in step 83, the 4-fold angle detection value P0(4X) of the main shaft is added to the 4-fold angle detection value P1(4X) to generate a discrimination value for use to discriminate the discrimination region. The discrimination value presents the discrimination waveform shown in Part (c) of
In step 84, a stepped waveform value shown in Part (a) of
Once the 1-fold angle detection value of the main shaft shown in Part (c) of
Finally, to properly perform the region discrimination described above in the gear mechanism used in the present invention, the accuracy required of the angle detector of the first counter-shaft will be discussed. First, let e1 and e2 denote the absolute values of errors in the detection values of the main shaft and first counter-shaft per rotation. When discrimination of M rotation cycles is performed between the main shaft and first counter-shaft using a 1-fold angle detector for the main shaft, generally e1+e2 needs to satisfy the following equation.
Now, if it is assumed that e1≈0, the error allowed for the angle detector of the first counter-shaft needs to satisfy Eq. (19) below.
Next, when an N-fold angle detector is used for the main shaft as with the present invention, since the first counter-shaft is multiplied by N, the following equation needs to be satisfied.
Now, if it is assumed that e1≈0, the following equation holds.
If it is assumed that a=N, the following equation holds.
After all, since Eq. (20) is equal to Eq. (19), the accuracy required of the angle detector of the first counter-shaft according to the present invention may be equal to the accuracy of the 1-fold angle detector attached to the main shaft.
In contrast, when the process shown in Patent Literature 1 is performed using an N-fold angle detector for the main shaft with the gear configuration disclosed in the literature, the accuracy required of a first driven gear needs to satisfy the following equation.
Now, if it is assumed that e1≈0, the following equation holds.
Thus, it can be seen that N times the accuracy available with the use of a 1-fold angle detector is required.
Number | Date | Country | Kind |
---|---|---|---|
2011-248663 | Nov 2011 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2012/076093 | 10/9/2012 | WO | 00 | 5/14/2014 |