The disclosure of Japanese Patent Application No. 2019-185406 filed on Oct. 8, 2019 including the specification, drawings and abstract is incorporated herein by reference in its entirety.
It relates to resolver correction device and correction method of resolver correction device, e.g. to a technique for correcting errors occurring in RDC (Resolver to Digital Converter) circuit.
There are disclosed techniques listed below.
Patent Document 1 discloses a signal converter comprising a first phase shifter for shifting phase of the first phase signal from resolver and a second phase shifter for shifting phase of the second phase signal from resolver and operating with phase difference between shift amount of the first phase shifter and shift amount of the second phase shifter set at a predetermined difference (90 degrees). Patent Document 2 discloses a resolver correction device that corrects shift amount setting value of phase shifter to be proportional to rotation speed of motor.
Resolver is known using a rotation angle (rotation speed) such as motor as a detect sensor. Detection signal from resolver is processed in the RDC circuit. As a process method of the RDC circuit, a method of generating a predetermined phase difference (90 degrees) by using two phase shifter circuits as shown in Patent Document 1 is known. Using such a scheme, since shift amount of the two phase shifter varies to the same degrees with respect to the change in the signaling frequency, it is possible to create a predetermined phase difference (90 degrees) in a certain frequency band.
However, the signal frequency is a value that is modulated according to rotation speed of motor, etc. For this reason, in the system of Patent Document 1, for example, when frequency modulation quantity is large, it may be difficult to keep phase difference at a predetermined phase difference (90 degrees). The error occurring for this predetermined phase difference (90 degrees) leads to a detection error of rotation angle (rotation speed). Therefore, as shown in Patent Document 2, it is conceivable to correct shift amount setting value of phase shifter so that it is proportional to rotation speed of motor. However, shift amount setting value compensation required is not necessarily proportional to rotation speed of motor.
The embodiments described later have been made in view of such, and other problems and novel features will become apparent from the description and the accompanying drawings of the present specification.
A resolver correction device according to one embodiment comprises: a first phase shifter for outputting a first phase signal by shifting a phase of a first detection signal is one of quadrature detection signals of the resolver by a first shift amount in accordance with a first shift amount setting value; a second phase shifter for outputting a second phase signal by shifting a phase of a second detection signal is the other of the quadrature detection signals by a second shift amount in accordance with a second shift amount setting value; an add circuit for outputting a third phase signal by adding the first phase signal and the second phase signal; an excitation signal supply circuit for supplying an excitation signal of an excitation frequency to the resolver during a normal operation, for supplying the excitation signals of a plurality of frequencies including the excitation frequency to the first phase shifter or the second phase shifter during a calibration operation; a phase difference detection circuit detecting a rotation angle of the resolver during the normal operation, and detecting the first shift amount or the second shift amount during the calibration operation, by detecting an phase difference between the excitation signal from the excitation signal supply circuit and the third phase signal from the add circuit; a shift amount searching circuit for searching the first shift amount setting value for each frequency of the excitation signal such that the first shift amount becomes a first specified amount, and for searching the second shift amount setting value for each frequency of the excitation signal such that the second shift amount becomes a second specified amount different by 90 degrees from the first specified amount, while referring to the detection result of the phase difference detection circuit during the calibration operation; and a storage circuit for storing the first shift amount setting value and the second shift amount setting value for each frequency of the excitation signal obtained by a search result of the shift amount searching circuit as a correction table.
According to the embodiment described above, the detection error of rotation angle, rotation speed, by resolver can be reduced.
In the following embodiments, when it is necessary for convenience, it is to be described by dividing it into sections or embodiments, but, unless otherwise specified, they are not irrelevant to one another and one is related to some or all of the other, such as modified example, detail, supplemental explanations, and the like. In the following embodiments, the number of elements or the like (including the number, number, quantity, range, and the like) is not limited to the specific number except the case where it is specified in particular or the case where it is obviously limited to the specific number in principle, and may be a specific number or more or less.
Furthermore, in the following embodiments, it is needless to say that the constituent elements (including element steps and the like) are not necessarily essential except in the case where they are specifically specified and the case where they are considered to be obviously essential in principle. Similarly, in the following embodiments, when referring to the shapes, positional relationships, and the like of components and the like, it is assumed that the shapes and the like are substantially approximate to or similar to the shapes and the like, except for the case in which they are specifically specified and the case in which they are considered to be obvious in principle, and the like. The same applies to the above numerical values and ranges.
The circuit elements constituting the functional blocks of the embodiment are formed on a semiconductor substrate such as single-crystal silicon by integrated circuit techniques such as, but not limited to, known CMOS, complementary MOS transistors.
Hereinafter, embodiments of the present invention are described in detail with reference to the drawings. In all the drawings for explaining the embodiments, the same members are denoted by the same reference numerals in principle, and repetitive descriptions thereof are omitted.
Each of the resolver digital converter RDC and the microcomputer MCU is composed of, for example, individual semiconductor chips, IC chips. However, the mounting mode is not limited to this, and can be changed as appropriate. Part or all of the various circuit blocks included in the microcomputer MCU can be replaced with FPGA, Field Programmable Gate Array, ASIC, Application Specific Integrated Circuit, or the like. That is, the various circuit blocks may be appropriately implemented using hardware processing, software processing, or a combination thereof.
Driver unit DVU includes, for example, a driver circuit DV such as a three-phase inverter, and a pre-driver circuit PDV for driving each switching element in the driver circuit DV (not shown). Pre-driver circuit PDV, for example, based on the three-phase PWM, Pulse Width Modulation, signal PWMu, PWMv, PWMw outputted from the microcomputer MCU, switching control of the respective switching elements in the driver circuit DV.
The resolver RSV is, for example, installed on a rotating shaft of the motor MT, detects the rotation angle θ of the motor MT, and outputs a detection signal E1 and a detection signal E2 which are quadrature detection signal, signals whose phase differs from each other by 90 degrees, reflecting the rotation angle θ. The resolver digital converter RDC process the detection signals E1, E2 from the resolver RSV. Specifically, the resolver digital converter RDC includes a selection switch SSW in addition to an excitation circuit EXC, differential amplifier AMP1, AMP2, phase shifters PSF1, PSF2, and the add circuit ADDU.
The excitation circuit EXC, by performing filtering process or the like in response to an excitation clock signal CKe of an excitation frequency fexc supplied from the microcomputer MCU, a sine wave of the excitation frequency fexc (angular velocity ω=2π×fexc) the excitation signal VIN (∝ sin(ωt)) to output. The resolver RSV receives the excitation signal VIN via the selection switch SSW, and outputs the detection signals E1 and E2. At this time, in accordance with the rotation angle, electric angle, θ of the motor MT, the detection signal E1 becomes “E1∝ sin(θ)×sin(ωt)”, the detection signal E2 becomes “E2∝ cos(θ)×sin(ωt)”.
Amplifiers AMP1 and AMP2 differentially amplify the detection signals E1 and E2 from the resolver RSV, respectively, and outputs phase signals V1 and V2. The phase shifter PSF 1 outputs a phase signal V1′ by shifting phase of the phase signal V1 (and thus the detection signal E1) by a predetermined shift amount according to a shift amount setting value SS1 from the microcomputer MCU. The phase shifter PSF2 outputs a phase signal V2′ by shifting phase of the phase signal V2 (and thus the detection signal E2) by the predetermined shift amount according to a shift amount setting value SS2 from the microcomputer MCU.
A shift amount of the phase shifter PSF2 is set so as to differ from a shift amount of the phase shifter PSF1 by 90 degrees (n/2). As a result, when the phase signal V1′ is “V1∝sin(θ)×sin(ωt)”, the phase signal V2′ is, for example, “V2′∝ cos(θ)×sin(ωt−π/2)=−cos(θ)×cos(ωt)”.
Add circuit ADDU outputs the phase signal, a detection clock signal CKd, by adding the phase signal V1′ from the phase shifter PSF1 and the phase signal V2′ from the phase shifter PSF2. Specifically, the add circuit ADDU includes an adder ADD for adding the phase signal V1′ and the phase signal V2′, and a comparator CMP for converting a phase signal V3′(=V1′+V2′) as a result of the addition into a rectangular wave, and outputs the phase signal V3′ as the detection clock signal CKd via the comparator CMP. As a result, the phase signal V3′(=V1′+V2′) becomes “V3′∝ cos(ωt+θ)”, and the detection clock signal CKd becomes a signal synchronized with phase of the phase signal V3′.
The Microcomputer MCU includes a PWM signal generator PWMG, an analog-to-digital converter ADC, an excitation signal supply circuit ESS, a timer TMR including a phase difference detection circuit PHD, a processor CPU, in addition to a shift amount searching circuit SSR, a shift amount correction circuit SCR, and the storage circuit MEM storing a correction table CTBLa. The processor CPU comprises a position detector PDET, a speed detector SDET and current controller PIC implemented by software-processing by the processor CPU. The shift amount searching circuit SSR, the shift amount correction circuit SCR, and the correction table CTBLa will be described later.
Excitation signal supply circuit ESS, for example, using a timer or the like, generates the excitation clock signal CKe to be the base of the excitation signal VIN, and supplies to the excitation circuit EXC of the resolver digital converter RDC. Phase difference detection circuit PHD detect a phase difference of the excitation clock signal CKe and the detection clock signal CKd from the add circuit ADDU as the timer TMR count. Position detector PDET detect rotation angle θ of the resolver RSV by converting the count value detected by this phase difference detection circuit PHD into an angle. Thus, substantially, the phase difference detection circuit PHD can detect rotation angle θ of the resolver RSV (and hence the motor MT) by detecting phase difference between the excitation signal VIN(∝ sin(ωt)) from the excitation signal supply circuit ESS and the phase signal V3′(∝ cos(ωt+θ)) from the add circuit ADDU.
The speed detector SDET detects a rotation speed (dθ/dt) of the resolver RSV based on a change rate of the rotation angle θ of the resolver RSV detected by the position detector PDET, substantially the phase difference detection circuit PHD. The analog-to-digital converter ADC converts, for example, the drive current Imt of the motor MT detected via a current sensor (not shown) in the driver circuitry DV into a digital value.
Current controller PIC is, for example, PI (proportional (P)·integral (I)) controller or the like, determines the target current based on the error between the target rotation speed and the rotation speed detected by the speed detector SDET, the target current, based on the error between the drive current Imt converted by the analog-to-digital converter ADC defining duty cycle of a PWM signal. The PWM signal generator PWMG, for example, constituted by a timer or the like, based on duty cycle defined by the current controller PIC, generates the PWM signals PWMu, PWMv, PWMw.
The resistor unit RU1 includes, for example, a plurality of resistor R11 and R12 connected in parallel, and a switch SW11 for switching enable and disable of resistor R11. The effective resistor of the resistor unit RU1 is controlled by switching the switch SW11 on or off at a predetermined time ratio based on the shift amount setting value SS1. That is, in this instance, the shift amount setting value SS1 is duty cycle PWMD1 of the PWM signal, and on or off the switch SW11 is controlled by the PWM signal having duty cycle PWMD1 concerned. As described above, the phase shifter PSF1 controls the RC circuit delay amount, and thus the shift amount, by switching enable and disable for a part of the plurality of resistor R11 and R12 in the RC circuit, the resistor unit RU1, by the PWM signal.
Similarly, the phase shifter PSF2 is, for example, an all-pass filtering, APF, and includes a resistor unit RU2, a capacitance C21, a plurality of resistor R23 to R26, switches SW22 to SW24, and an amplifier AMP21. The resistor unit RU2 and the capacitance C21 constitute the RC circuit and transmit the phase signal V2 to the (+) input terminal of the amplifier AMP21. Resistors R23-R26 are the input resistor or feedback resistor to the (−) input terminal of the amplifier AMP21. The ratio between the input resistor and the feedback resistor can be set variably by the switches SW22 to SW24.
The resistor unit RU2 includes a plurality of resistor R21 and R22 connected in parallel, and a switch SW21 for switching enable and disable of resistor R21, similarly to the resistor unit RU1. The shift amount setting value SS2 is duty cycle PWMD2 of the PWM signal, the on or off the switch SW21 is controlled by the PWM signal having duty cycle PWMD2. As described above, the phase shifter PSF2 also controls the shift amount by switching enable or disable of a part of the plurality of resistor R21 and R22 in the RC circuit, the resistor unit RU2, by the PWM signal.
Incidentally, a plurality of resistor in the resistor unit may be a series connection is not limited to parallel connection. In this case, a switch may be provided to bypass a portion of resistor connected in series. In addition, although the effective resistor of the resistor unit is controlled by the PWM signal, it is not limited to this, and various variable resistor schemes can be used. However, by using the PWM control method, the effective resistor resolution can be enhanced without complicating the hardware. That is, the higher duty cycle setting resolution of the PWM signal by the microcomputer MCUs (and hence the higher the clocking frequency), the higher the resolution of the effective resistor. In addition, although resistor in the RC circuit is variably controlled here, the capacitance may be variably controlled instead.
In
On the other hand, if the rotation speed fm [rpm] of the motor MT (the resolver RSV) is non-zero, the output frequency fres is a value that is modulated according to the rotation speed fm of the motor MT. Consequently, the output frequency fres becomes the value of equation (1) using the excitation frequency fexc(=ω/2π), the rotation speed fm, and the number of poles Np of the resolver RSV. Thus, the output frequency fres, for example, when the excitation frequency fexc is 20 kHz, becomes higher than 20 kHz when the motor MT rotates forward, lower than 20 kHz when the motor MT rotates backward.
fres=fexc+(fm/60)×Np: equation (1)
Here, first, a case in which the method of Patent Document 1 described above is used will be described. When the two phase shifters PSF1 and PSF2 are used as in Patent Document 1, phase difference can be kept at approximately 90 degrees in the vicinity of the excitation frequency fexc (20 kHz), as shown in
In the phase shifters PSF1 and PSF2, as shown in
Next, a case in which the method of Patent Document 2 described above is used will be described. In the method of Patent Document 2, for example, in
However, the corrected quantity of the shift amount setting value originally required is not necessarily proportional to the rotation speed fm of the motor MT. That is, as shown in
In addition, in Patent Document 2 method, the shift amount setting value of the phase shifters PSF1 and PSF2 must be controlled, corrected, after the rotation speed fm of the motor MT is detected. In this case, a control delay occurs. This control delay may not sufficiently reduce phase difference setting error.
Therefore, the resolver correction device of
Here, the resolver correction device of
Phase difference detection circuit PHD detect phase difference between the excitation clock signal CKe (and thus the excitation signal VIN) from the excitation signal supply circuit ESS and the detection clock signal CKd (and hence the phase signal V3′) from the add circuit ADDU, as described in
In the calibration operation, if the excitation signal VIN is supplied to the phase shifter PSF1 via the selection switch SSW, the phase signal V2′ from the phase shifter PSF2 to the add circuit ADDU is null. Therefore, the phase difference detection circuit PHD can detect the shift amount of the phase shifter PSF1 by turning detect phase difference between the detection clock signal CKd and the excitation clock signal CKe corresponding to the phase signal V1′ from the add circuit ADDU. The same applies when the excitation signal VIN is supplied to the phase shifter PSF2 via the selection switch SSW.
The shift amount searching circuit SSR instructs the excitation signal supply circuit ESS to frequency of the excitation signal VIN at the time of the calibration operation, and search the shift amount setting value SS1 such that the shift amount of the phase shifter PSF1 becomes a specified amount (e.g., 45 degrees) for each frequency while referring to detection result of the phase difference detection circuit PHD for each frequency. Similarly, the shift amount searching circuit SSR searches the shift amount setting value SS2 such that the shift amount of the phase shifter PSF2 is the specified amount (e.g., 135 degrees) for the phase shifter PSF2 at every frequency of the excitation signal VIN. The shift amount searching circuit SSR registers a search result in the correction table CTBLa.
In the calibration operation, frequency of the excitation signal VIN can be regarded as the output frequency fres described in
In
In
In this condition, the shift amount searching circuit SSR, for example, by deactivating one of the phase shifters PSF1, PSF2, or the like, turns disable one of the phase signals V1′, V2′. Consequently, the add circuit ADDU can output one of the phase signals V1′ and V2′ as the phase signal V3′. However, in this instance, the shift amount of the phase shifters PSF1, PSF2 detected by the phase difference detection circuit PHD may include errors that depend on the configuration of the resolver RSV. From the viewpoint of eliminating such errors, it is desirable to provide the selection switch SSW.
Next, the shift amount searching circuit SSR search the shift amount setting value SS1 in which the shift amount detected by the phase difference detection circuit PHD becomes the specified amount (here, 45 degrees) while sequentially changing the shift amount setting value SS1 (duty cycle PWMD1) (S104). Then, the shift amount searching circuit SSR registers the corresponding relation between frequency f [k] of the step S102 and the shift amount setting value SS1 (duty cycle PWMD1), which is search result of the step S104, in the correction table CTBLa (step S105).
Subsequently, in the steps S106 to S108, the same process as in the steps S103 to S105 is performed for the calibration path [2] for supplying the excitation signal VIN to the phase shifter PSF2. That is, the selection switch SSW selects the calibration pass [2] (step S106), and the shift amount searching circuit SSR search (step S107) the shift amount setting value SS2 (duty cycle PWMD2) in which the shift amount detected by the phase difference detection circuit PHD becomes the specified amount (here, 135 degrees). Then, the shift amount searching circuit SSR registers the corresponding relation between frequency f [k] and the shift amount setting value SS2 (duty cycle PWMD2) in the correction table CTBLa (step S108).
Thereafter, the shift amount searching circuit SSR repeats the process of the steps S102 to S108 until k=kmax while sequentially changing k (steps S109, S110). As a result, in the correction table CTBLa of
The shift amount correction circuit SCR then uses the excitation frequency fexc, the rotation speed fm detected in the step S203, and the number of poles Np of the resolver RSV, which is determined in advance, to calculate (step S204) the output frequency fres of the detection signals E1, E2 based on the aforementioned equation (1). The shift amount correction circuit SCR obtains the shift amount setting values SS1, SS2 (duty cycle PWMD1, PWMD2) by referring to the correction table CTBLa using the output frequency fres calculated in step S204 as a search key (step S205). The shift amount correction circuit SCR sets the shift amount setting values SS1, SS2 acquired in step S205 to the phase shifters PSF1, PSF2 (step S206).
Here, the resolver correction device repeatedly executes the process of the steps S202 to S206, for example, at every control period of the speed detector SDET while performing the normal operation (step S207). In step S205, the shift amount correction circuit SCR linearly interpolate, for example, the shift amount setting values SS1 and SS2 according to the values of the output frequency fres. Taking the correction table CTBLa in
As described above, by using the resolver correction device of first embodiment, the shift amount setting values SS1, SS2 for each output frequency fres for maintaining the prescribed shift amount (45 degrees, 135 degrees) of the phase shifters PSF1, PSF2 can be acquired in advance at the time of the calibration operation. This allows phase difference between the phase shifters PSF1 and PSF2 to be kept at 90 degrees with high accuracy regardless of the rotation speed fm of the motor MT or the pole count Np of the resolver RSV. Consequently, the detection error of the rotation angle θ (the rotation speed dθ/dt) by the resolver RSV can be reduced, and thus the motor MT can be controlled with high accuracy.
In addition, by using the existing the phase difference detection circuit PHD to turn detect the shift amount of the phase shifters PSF1 and PSF2, the area overhead associated with detecting the shift amount can be reduced. That is, for example, there is no need to provide a dummy phase shifter or the like for detecting the shift amount. In addition, compared with Patent Document 2 system, even when the relationship between the output frequency fres and the correction amount of the shift amount setting value is not proportional but has any characteristics, an appropriate correction amount can be determined. Furthermore, in the normal operation, since it is sufficient to refer to the correction table CTBLa defined at the time of the calibration operation, the control delay associated with the correction can be reduced.
In second embodiment method, unlike first embodiment method, the shift amount setting values SS1, SS2 of the phase shifters PSF1, PSF2 are set to fixed values at the time of the normal operation. Instead, a shift amount error from specified amount (e.g., 45 degrees, 135 degrees) in the phase shifters PSF1, PSF2 is detected every output frequency fres at the calibration operation. If the shift amount error for each output frequency fres is known in advance, at the time of the normal operation, it is possible to correct the shift amount error corresponding to the present output frequency fres using arithmetic expression, it is possible to calculate the true rotation angle θ and the rotation speed (dθ/dt).
The shift amount error detection circuit SED detect the shift amount error contained in the shift amount of the phase shifter PSF1 detected in the phase difference detection circuit PHD at every frequency of the excitation signal VINs, with reference to the specified amount (e.g. 45 degrees) at the calibration operation. Similarly, the shift amount error detection circuit SED detect the shift amount error contained in the shift amount of the phase shifter PSF2 detected in the phase difference detection circuit PHD for each frequency of the excitation signal VINs, with reference to specified amount (e.g., 135 degrees).
Correction table CTBLb store the shift amount error of the phase shifters PSF1 and PSF2 for each frequency of the excitation signal VINs detected by the shift amount error detection circuit SED.
The shift amount setting circuit SST searches shift amount setting values SS1 and SS2 such that the shift amount of the phase shifters PSF1, PSF2 is the specified amount (45 degrees, 135 degrees) while referring to detection result of the phase difference detection circuit PHD with the excitation signal VIN set to the excitation frequency fexc (for example, 20 kHz) as the initial operation during the calibration operation. The shift amount setting circuit SST sets the shift amount setting values SS1, SS2, which is the search result, to the phase shifters PSF1, PSF2 at the time of the calibration operation and at the time of the normal operation.
The detection result corrector RTC corrects the rotation angle of the resolver RSV detected by the phase difference detection circuit PHD based on the retained content of the correction table CTBLb and the predetermined arithmetic expression at the normal operation. Specifically, the detection result corrector RTC first calculate the output frequency fres of the detection signals E1 and E2 based on the rotation speed (apparent the rotation speed (dθ0/dt=fm)) detected in the speed detector SDET and the excitation frequency fexc of the excitation signal VIN and the number of poles Np of the resolver RSV.
Subsequently, the detection result corrector RTC obtains the shift amount error Δφ0 and Δφ1 of the phase shifters PSF1 and PSF2 by referring to the correction table CTBLb using the output frequency fres as search keys. The detection result corrector RTC corrects the rotation angle of the resolver RSV based on arithmetic expression using the rotation angle (apparent the rotation angle θ0) of the resolver RSV detected by the shift amount error Δφ0, Δφ1, and the phase difference detection circuit PHD (the position detector PDET) as parameters, and calculate the true rotation angle θ. The current controller PIC determines duty cycle based on a true rotation speed (dθ/dt) obtained from the true rotation angle θ, and instructs the PWM signal generator PWMG.
V1=sin θ×sin ωt: equation (2)
V2=cos θ×sin ωt: equation (3)
Let us now assume that the phase shifters PSF1, PSF2 shifts the phase signal V1 by 45 degrees (=π/4) and the phase signal V2 by 135 degrees (=3π/4). At this time, as shown in
Add circuit ADDU outputs the phase signal V3′(=V1′+V2′) of the equation (7) by adding the phase signal V1′ of the equation (4) and the phase signal V2′ of the equation (6).
V3′=sin θ sin(ωt+π/4+Δφ0)+cos θ{cos(ωt+π/4+Δφ0)×(1−Δφ12/2)−sin(ωt+π/4+Δφ0)×Δφ1}=cos((ωt+π/4+Δφ0)−θ)−cos θ(Δφ12/2+sin(ωt+π/4+Δφ0)×Δφ1): equation (7)
Add circuit ADDU converts the phase signal V3′ of the equation (7) into a rectangular wave (the detection clock signal CKd) by using the comparator CMP. At this time, since the comparator CMP detects phase at the midpoint (amplitude center) of the phase signal V3′, the comparator CMP detects phase as “ωt=π/4−Δφ0+θ” which satisfies “cos((ωt+π/4+Δφ0)−θ)=0”. The error ΔV3′ of the phase signal V3′ at the time of detecting phase is expressed by equation (8).
When the comparator CMP detects phase (“ωt=π/4−Δφ0+θ”) by the comparator CMP, the temporal derivative of the phase signal V3′ of the equation (7) becomes “d(V3′)/dt=−ω(1−Δφ1×cos θ sin θ)≈−ω”. Therefore, the time conversion error Δt at the time of detecting phase by the comparator CMP becomes equation (9) using equation (8).
As f(=ω/2π) frequency after frequency modulation, when converting the time conversion error Δt of equation (9) to the electrical angle conversion error Δθ, the electrical angle conversion error Δθ at the time of detecting phase by the comparator CMP is equation (10).
Δθ=2π×Δt/(1/f)=−Δφ1 cos θ(Δφ1/2+cos θ): equation (10)
On the other hand, the phase difference detection circuit PHD is detect as the apparent rotation angle θ0 obtained by adding the electric angle conversion error Δθ to phase “ωt=π/4−Δφ0+θ” detected by the comparator CMP. Therefore, the true rotation angle θ is obtained by equation (11).
θ=θ0−π/4−Δφ0−Δθ: equation (11)
Based on equation (10) and equation (11), the final electric angle conversion error Δθ becomes equation (12), the true rotation angle θ becomes equation (13).
Δθ=−Δφ1 cos(θ0−π/4+Δφ0)(Δφ1/2+cos(θ0−π/4+Δφ0)): equation (12)
θ=θ0−π/4−Δφ0+Δφ1 cos(θ0−π/4+Δφ0)(Δφ1/2+cos(θ0−π/4+Δφ0)): equation (13)
As shown in equation (13), the true rotation angle θ can be calculated based on the apparent rotation angle θ0 of the resolver RSV detected by the phase difference detection circuit PHD (the position detector PDET) and the shift amount error Δφ0 and θφ1 of the phase shifters PSF 1 and PSF2 occurring at the time of the detection. The detection result corrector RTC obtains the shift amount error Δφ0 and Δφ1 corresponding to the present output frequency fres from the correction table CTBLb, thereby calculating the true rotation angle θ based on equation (13).
Subsequently, the selection switch SSW selects a calibration path [1] (a path to the phase shifter PSF1) in response to an instruction from the shift amount setting circuit SST (step S202). Then, the shift amount setting circuit SST search the shift amount setting value SS1 in which the shift amount detected by the phase difference detection circuit PHD becomes the specified amount (here, 45 degrees) while sequentially changing the shift amount setting value SS1 (duty cycle PWMD1).
The calibration path [2] (path to the phase shifter PSF2) is then subjected to the same process as for steps S202, S203. Specifically, the selection switch SSW selects the calibration pass [2] (step S204), and the shift amount setting circuit SST searches (step S205) the shift amount setting value SS2 (duty cycle PWMD2) in which the shift amount detected by the phase difference detection circuit PHD is specified amount (here, 135 degrees). The shift amount setting circuit SST sets the shift amount setting values SS1, SS2 (PWMD1, PWMD2), which is the search result of steps S203, S205, to the phase shifters PSF1, PSF2 (step S206).
Subsequently, the excitation signal supply circuit ESS, in response to an instruction from the shift amount error detection circuit SED, (step S301) as k=0, the excitation clock signal CKe of frequency f [k] (and thus the excitation signal VIN) (step S302). The selection switch SSW then selects the calibration path [1] according to the instructions from the shift amount error detection circuit SED (step S303). The shift amount error detection circuit SED detect (step S304) the shift amount error Δφ0 (i.e. error with 45 degrees) based on detection result of the phase difference detection circuit PHD. The shift amount error detection circuit SED registers the corresponding relation between frequency f [k] of the step S302 and the shift amount error Δφ0 which is detection result of the step S304 in the correction table CTBLb, in step S305.
Next, in the steps S306 to S308, the same process as in the steps S303 to S305 is performed for the calibration pass [2]. The selection switch SSW selects the calibration pass [2] (step S306) and the shift amount error detection circuit SED detects the shift amount error Δφ1 through detecting the shift amount error “Δφ0+Δφ1” (i.e. the error with 135 degrees) (step S307). Then, the shift amount error detection circuit SED registers the correspondence between frequency f [k] and the shift amount error Δφ1 in the correction table CTBLb (step S308).
Thereafter, the shift amount error detection circuit SED repeat the process of the steps S302 to S308 until k=kmax while sequentially changing k (steps S309, S310). As a result, in the correction table CTBLb in
Subsequently, in steps S402 to S404, as in steps S202 to S204 of
Subsequently, the detection result corrector RTC obtains the shift amount error Δφ0 and Δφ1 by referring to the correction table CTBLb using the output frequency fres calculated in step S404 as search keys (step S405). The detection result corrector RTC performs correction based on equation (13) using the shift amount error Δφ0 and Δφ1 obtained by Step S405, and the apparent rotation angle θ0 detected by Step S402 to calculate the true rotation angle θ (and thus the true rotation speed dθ/dt) (Step S406).
Then, the resolver correction device, while performing the normal operation, the process of the steps S402 to S406, for example, repeatedly executes at each control period of the speed detector SDET (step S407). In step S405, the detection result corrector RTC appropriately linearly interpolate the shift amount error Δφ0 and Δφ1 in accordance with the values of the output frequency fres, as in step S205 in
Use second embodiment's the resolver correction device to achieve the same effect as first embodiment. In particular, the detection error of the rotation angle θ (the rotation speed dθ/dt) by the resolver RSV can be reduced, thus enabling high-precision control of the motor MT.
As shown in
Further, as compared with first embodiment method, since it is not necessary to variably control the shift amount setting values SS1, SS2 (duty cycle PWMD1, PWMD2) at the time of the normal operation, for example, it is not necessary to consider the effect of the switching timing or the like accompanying the variable control. Further, in first embodiment method, the detection error depends on, for example, the set resolution of duty cycles PWMD1, PWMD2, and the like, but in second embodiment method, such dependence does not easily occur.
The microcomputer MCU shown in
The shift amount error detection circuit SED reflects the shift amount setting values SS1 and SS2, which are search result of the shift amount searching circuit SSR, and then detects the shift amount errors Δφ0 and Δφ1 remaining in shift amount of the phase shifters PSF1 and PSF2 detected by the phase difference detection circuit PHD for each frequency of the excitation signals VIN at the time of the calibration operation. Then, the shift amount error detection circuit SED registers the shift amount errors Δφ0, Δφ1 for each frequency of the excitation signals VIN to the correction table CTBLc.
The shift amount correction circuit calculates the output frequency fres based on the rotation speed and the like detected by the speed detector SDET, and obtains the corresponding duty cycles PWMD1 and PWMD2 from the correction table CTBLc and sets them in the phase shifters PSF1, PSF2 at the time of the normal operation, as in the case of first embodiment. The detection result corrector RTC calculates the output frequency fres on the basis of the rotation speed (apparent rotation speed (dθ0/dt)) and the like detected by the speed detector SDET and acquires the corresponding shift amount error Δφ0 and Δφ1 from the correction table CTBLc at the time of passing the normal operation in the same manner as second embodiment RTC. The detection result corrector RTC corrects the rotation angle based on arithmetic expression of equation (13) using the shift amount error Δφ0, Δφ1 and the rotation angle (apparent rotation angle θ0) detected by the phase difference detection circuit PHD (the position detector PDET) to calculate the true rotation angle θ (and thus the true rotation speed (dθ/dt)).
Next, the shift amount searching circuit SSR search the shift amount setting value SS1 in which shift amount detected by the phase difference detection circuit PHD becomes the specified amount (here, 45 degrees) while sequentially changing the shift amount setting value SS1 (duty cycle PWMD1) (S504). The shift amount searching circuit SSR sets the shift amount setting value SS1, which is the search result, to the phase shifter PSF1.
In this condition, the shift amount error detection circuit SED detect the shift amount error Δφ0 of the phase shifter PSF1 (i.e., the error from 45 degrees) based on detection result of the phase difference detection circuit PHD (S505 step). The table generation circuit TBG registers the correspondence among frequency f [k] of the step S502, the shift amount setting value SS1 (duty cycle PWMD1), which is the search result of the step S504, and the shift amount error Δφ0, which is detection result of the step S505, in the correction table CTBLc (step S506).
Subsequently, in the steps S507 to S510, the same process as in the steps S503 to S506 is performed for the calibration path [2] (the path to the phase shifter PSF2). That is, the selection switch SSW selects the calibration pass [2] (step S507), and the shift amount searching circuit SSR search (step S508) the shift amount setting value SS2 (duty cycle PWMD2) in which shift amount detected by the phase difference detection circuit PHD becomes the specified amount (here, 135 degrees).
With this search result reflected, the shift amount error detection circuit SED detect the shift amount error Δφ2 (step S509) through the detection of the shift amount error of the phase shifter PSF2 “the shift amount error” of the phase shifter PSF2 “Δφ0+Δφ1” (i.e., an error of 135 degrees) based on detection result of the phase difference detection circuit PHD. Then, the table generation circuit TBG registers the corresponding relation among frequency f [k] of the step S502, the shift amount setting value SS2 (duty cycle PWMD2) which is the search result of the step S508, and the shift amount error Δφ1 which is detection result of the step S509 in the correction table CTBLc (step S510).
Thereafter, the shift amount searching circuit SSR repeats the process of the steps S502 to S510 until k=kmax while sequentially changing k (steps S511, S512). As a result, the correction table CTBLc as shown in
Subsequently, in steps S602 to S604, as in steps S202 to S204 of
Subsequently, the shift amount correction circuit SCR obtains the shift amount setting values SS1, SS2 (duty cycles PWMD1, PWMD2) corresponding to the calculated output frequency fres from the correction table CTBLc (step S605), and sets the phase shifters PSF1, PSF2 (step S606). The detection result corrector RTC obtains the shift amount errors Δφ0 and Δφ1 corresponding to the calculated output frequency fres from the correction table CTBLc (step S607). Then, the detection result corrector RTC performs correction based on the equation (13) using the obtained shift amount errors Δφ0 and Δφ1 and the apparent rotation angle θ0 detected in the step S602, and calculates (step S608) the true rotation angle θ (and thus the true rotation speed dθ/dt).
Then, the resolver correction device, while performing the normal operation, the process of the steps S602 to S608, for example, repeatedly executed at each control period of the speed detector SDET (step S609). In step S605, in detail, the shift amount correction circuit SCR linearly interpolate the shift amount setting values SS1 and SS2 according to the values of the output frequency fres. Similarly, in step S607, the detection result corrector RTC linearly interpolate the shift amount error Δφ0 and Δφ1 as appropriate, in particular depending on the values of the output frequency fres.
The use of third embodiment's the resolver correction device produces the same effect as first and second embodiments. In addition, compared with the cases of first and second embodiments, the detection error of the rotation angle θ (the rotation speed dθ/dt) by the resolver RSV can be further reduced, thus enabling the motor MT to be controlled with higher precision. Specifically, for first embodiment method, as described above, in order to reduce the detection error, it is necessary to increase the setting resolution of duty cycle (and thus the clock frequency) associated with the shift amount setting value.
On the other hand, in second embodiment system, for example, in the above-described equation (6), the correction error increases when the shift amount error Δφ1 increases because the approximate expression of “sin Δφ1=Δφ1” is used on the assumption that it is sufficiently small. As a specific example, when the shift amount error Δφ1 is about 20 degrees is sin(Δφ1)=0.349 Δφ1 with respect to 0.342, approximate error of about 2% occurs.
Therefore, by combining first embodiment method with second embodiment method, it is possible to reduce the shift amount error θφ1 to, for example, 5 degrees or less. In this case, for sin(Δφ1)=0.0871 is Δφ1=0.0872, the approximate error can be suppressed to about 0.1%. In another aspect, by combining second embodiment method with first embodiment scheme, even when duty cycle setting resolution (clock frequency) associated with the shift amount setting value is low, the detection error of the rotation angle θ (the rotation speed dθ/dt) can be sufficiently reduced using the correction equation. Even when the performance of the microcomputer MCU is low, satisfactory detection accuracy can be obtained.
In this condition, the correction necessity determination circuit CJG causes the shift amount error detection circuit SED to detect the shift amount error Δφ0 and Δφ1 corresponding to the excitation frequency fexc in the phase shifters PSF1 and PSF2. Then, the correction necessity determination circuit CJG compares the shift amount error Δφ0, Δφ1 is detection result, the shift amount error Δφ0, Δφ1 held in the correction table CTBLc. The correction necessity determination circuit CJG selects whether the calibration operation [3] shown in
If the correction table CTBLc is not generated in the step S700, the correction necessity determination circuit CJG starts the calibration operation [3] in
Subsequently, the correction necessity determination circuit CJG issues an instruction to the shift amount correction circuit SCR, and in response, the shift amount correction circuit SCR sets the shift amount setting values SS1, SS2 corresponding to the excitation frequency fexc obtained from the correction table CTBLc to the phase shifters PSF1, PSF2 (step S702). The correction necessity determination circuit CJG then causes the shift amount error detection circuit SED to detect the shift amount error Δφ0, Δφ1 (step S703). Specifically, the shift amount error detection circuit SED detect the shift amount error Δφ0 and Δφ1 while switching the calibration path, as shown in the steps S303, S304, S306, S307 of
Then, in step S704, the correction necessity determination circuit CJG compares the shift amount error Δφ0 and Δφ1 detected in step S703 with the shift amount error Δφ0 and Δφ1 corresponding to the excitation frequency fexc in the correction table CTBLc. The correction necessity determination circuit CJG starts the normal operation [3] in
Here, the correction necessity determination circuit CJG has automatically started the normal operation [3] or the calibration operation [3], but it may perform a process such that this activation is left to the user. Specifically, the correction necessity determination circuit CJG assigns flags to the case of “No” of the step S700 and the case of “Yes” and “No” of the step S704, respectively, and notifies the user of the flags. The user instructs the resolver correction device to execute the normal operation [3] or the calibration operation [3] based on the flag.
The use of fourth embodiment's the resolver correction device allows the rotation angle θ (the rotation speed dθ/dt) detection error due to resolver RSV to be reduced while reducing the number of calibration operation in addition to the various benefits described in third embodiment. More specifically, frequent the calibration operation may reduce the utilization rate of the systems. On the other hand, when using the results of the calibration operation for a long period of time, for example, the environmental change of the system (temperature or the like) and, due to aging of the circuit elements, there is a possibility that the detection error is increased.
When fourth embodiment method is used, the necessity of the calibration operation can be determined so that the calibration operation can be performed only when it is truly required. Further, since the necessity determination of the calibration operation is performed by a single the excitation frequency fexc, the time required for the necessity determination is not particularly problematic. In this example, although the correction necessity determination circuit CJG is added to the configuration example of
Although the invention made by the present inventor has been specifically described based on the embodiment, the present invention is not limited to the embodiment described above, and various modifications can be made without departing from the gist thereof. For example, the foregoing embodiments have been described in detail for the purpose of illustrating the present invention easily, and are not necessarily limited to those comprising all the configurations described. In addition, a part of the configuration of one embodiment can be replaced with the configuration of another embodiment, and the configuration of another embodiment can be added to the configuration of one embodiment. It is also possible to add, delete, or replace some of the configurations of the respective embodiments.
Number | Date | Country | Kind |
---|---|---|---|
2019-185406 | Oct 2019 | JP | national |