Vibration Angular Velocity Sensor
By designing the primary and secondary control circuits of the closed control loop in the vibration-type angular velocity sensor, the offset value correction and loop filter input addition are used to solve the problem of symmetry offset during switching and improve the measurement accuracy and control symmetry, suppressing the impact of temperature fluctuations.
Patent Information
- Application Number
- CN202180021348.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2020-03-24
- Filing Date
- 2021-03-23
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2041-03-23
AI Technical Summary
The existing vibration-type angular velocity sensors tend to lose symmetry when switching electrode connections, resulting in an increase in temperature fluctuation of unabolized bias components, affecting measurement accuracy.
By designing the primary and secondary control circuits of the closed control loop in the vibration-type angular velocity sensor, the offset value is added to the input of the loop filter for correction, ensuring that the offset value before and after replacement is symmetrical, and through adjustment The output characteristics of the primary and secondary control loops reduce the error caused by temperature changes.
It effectively suppresses the increase of temperature variation components that have not been eliminated, improves measurement accuracy and control symmetry, and reduces the impact of temperature changes on sensor output.
Smart Images

Figure CN115280099B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a vibration type angular velocity sensor, and in particular to a vibration type angular velocity sensor having a primary side control circuit for causing primary vibration in a vibrator and a secondary side control circuit for detecting and outputting secondary vibration generated in the vibrator due to an angular velocity applied to the vibrator. Background Art
[0002] Conventionally, a vibration type angular velocity sensor is known and is disclosed in, for example, Japanese Patent Application Laid-Open No. 2009-115559 and Japanese Patent No. 6463335.
[0003] In Japanese Patent Publication No. 2009-115559, a plurality of electrodes are arranged in a circumferential shape on the radial outer side of the annular element portion and the annular element portion. The plurality of electrodes include a primary electrode and a secondary electrode. An AC power source is connected to one of the primary electrode and the secondary electrode, and the AC power source generates a primary vibration in the annular element portion by applying an AC voltage to one of the primary electrode and the secondary electrode. In addition, a detection mechanism is connected to the other of the primary electrode and the secondary electrode, and the detection mechanism detects the size of the electric signal generated in the other of the primary electrode and the secondary electrode. In addition, if a rotational motion occurs around the normal direction of the element portion in a state where the annular element portion generates a primary vibration, a secondary vibration corresponding to the angular velocity of the rotational motion is generated in the element portion. In addition, the size of the electric signal generated in the other of the primary electrode and the secondary electrode due to the secondary vibration is detected by the detection mechanism connected to the other of the primary electrode and the secondary electrode. In addition, an AC voltage for eliminating the secondary vibration is applied to one of the primary electrode and the secondary electrode according to the size of the detected electric signal. Then, the magnitude of the angular velocity is calculated based on the magnitude of the AC voltage for canceling the secondary vibration.
[0004] Furthermore, in conventional vibration type angular velocity sensors such as those described in Japanese Patent Application Publication No. 2009-115559, the angular velocity detected by the vibration type angular velocity sensor includes a bias component (an error from a zero point outputted from the angular velocity sensor even when no angular velocity is applied). The bias component is generated due to the asymmetry of the gyro element included in the vibration type angular velocity sensor. Therefore, conventional vibration type angular velocity sensors such as those described in Japanese Patent Application Publication No. 2009-115559 are configured to switch an electrode connected to an AC power source (one of the primary electrode and the secondary electrode) and an electrode connected to a detection mechanism (the other of the primary electrode and the secondary electrode). Furthermore, the bias component is eliminated by performing a differential operation on the output of the vibration type angular velocity sensor before and after the switching.
[0005] Here, in a vibration type angular velocity sensor that eliminates the bias component by switching the electrode connected to the AC power supply and the electrode connected to the detection mechanism as described in Japanese Patent Application Laid-Open No. 2009-115559, a bias component that is not eliminated and remains may be generated. In this case, the remaining bias component changes depending on the temperature of the surrounding environment.
[0006] Japanese Patent No. 6463335 discloses a vibration type angular velocity sensor, which includes a primary side control circuit that causes primary vibration in a vibrator and a secondary side control circuit that detects and outputs secondary vibration generated in the vibrator due to the angular velocity applied to the vibrator. In the vibration type angular velocity sensor, both the primary side control circuit and the secondary side control circuit are composed of a closed control loop. In addition, a first offset value based on the output of the primary side control circuit that is inversely proportional to the temperature change of the gain of the vibrator and a second offset value based on a constant signal that is independent of temperature are added to the closed control loop of the secondary side control circuit. Thus, the error caused by the crosstalk from the primary side control circuit to the secondary side control circuit (the error that is inversely proportional to the first power and the square of the gain of the vibrator) is reduced. In addition, the first offset value and the second offset value are adjusted to reduce the error caused by the crosstalk from the primary side control circuit to the secondary side control circuit. Thus, the sensor output from the secondary side control circuit is corrected. As a result, the temperature change of the output from the vibration type angular velocity sensor (the output value changes according to the surrounding temperature) can be reduced.
[0007] Furthermore, for a vibration type angular velocity sensor that eliminates a bias component by switching an electrode connected to an AC power supply and an electrode connected to a detection mechanism as described in Japanese Patent Publication No. 2009-115559, the structure of Japanese Patent No. 6463335 is applied before and after the switching, thereby reducing the temperature variation of the residual bias component.
[0008] Previous technical literature
[0009] Patent Literature
[0010] Patent Document 1: Japanese Patent Application Publication No. 2009-115559
[0011] Patent Document 2: Japanese Patent No. 6463335 Summary of the invention
[0012] Technical issues to be solved by the invention
[0013] However, as described in Japanese Patent Publication No. 2009-115559, in order to eliminate the bias component by switching the electrode connected to the AC power supply and the electrode connected to the detection mechanism, the symmetry of the control of the vibration type angular velocity sensor before and after the switching becomes important. Here, if the structure of Japanese Patent No. 6463335 is applied before and after the switching, and the first offset value and the second offset value are set separately for before and after the switching, the first offset value and the second offset value before and after the switching are usually asymmetric. Therefore, if the asymmetric first offset value and the second offset value are set before and after the switching, the control of the vibration type angular velocity sensor loses symmetry, and there is a problem that the temperature variation component of the bias that is not eliminated and remains sometimes becomes larger.
[0014] The present invention has been made to solve the above-mentioned problems, and one object of the present invention is to provide a vibration type angular velocity sensor capable of suppressing an increase in a temperature variation component of an offset that is not eliminated but remains.
[0015] Means for solving technical problems
[0016] In order to achieve the above-mentioned purpose, the vibration type angular velocity sensor based on the first aspect of the present invention comprises: a vibrator; a primary side control circuit, having a closed control loop, the output of which causes the vibrator to cause primary vibration; and a secondary side control circuit, which detects the secondary vibration generated in the vibrator due to the angular velocity applied to the vibrator and has a closed control loop, and is constructed to correct the sensor output by adding an offset value to the closed control loop, the primary side control circuit and the secondary side control circuit are constructed to be able to replace the function as a primary side control circuit and the function as a secondary side control circuit, and the offset value after the replacement and the offset value before the replacement are symmetrical values relative to a specified reference value.
[0017] In the vibration type angular velocity sensor according to the first aspect of the present invention, as described above, the primary side control circuit and the secondary side control circuit are configured so that the function as the primary side control circuit and the function as the secondary side control circuit can be replaced, and the offset value after the replacement and the offset value before the replacement are symmetrical with respect to a prescribed reference value. Thus, before and after the replacement of the function as the primary side control circuit and the function as the secondary side control circuit, the offset value is symmetrical with respect to the prescribed reference value, so that the control of the vibration type angular velocity sensor before and after the replacement can be suppressed from losing symmetry. As a result, the temperature variation component of the bias that is not eliminated and remains can be suppressed from increasing.
[0018] In the vibration type angular velocity sensor based on the first aspect, preferably, the primary side control circuit and the secondary side control circuit respectively include a primary side loop filter and a secondary side loop filter in a closed control loop, and are configured to correct the sensor output by adding an offset value to the input of the secondary side loop filter. Here, the output in the closed control loop corresponds to the output of the loop filter. And, the output of the loop filter is inversely proportional to the gain (gain) of the oscillator that depends on the temperature through the feedback action of the closed control loop. In the present invention, focusing on this point, by adding an offset value to the input of the secondary side loop filter, the error caused by crosstalk that is inversely proportional to the first power and / or square of the gain of the oscillator can be reduced.
[0019] In the vibration type angular velocity sensor according to the first aspect, preferably, when the offset value before replacement is set to a, the offset value after replacement is -a in which the polarity of the offset value before replacement is reversed. If so configured, the offset value is symmetrical with respect to zero before and after the function as the primary side control circuit and the function as the secondary side control circuit are replaced, thereby preventing the vibration type angular velocity sensor from losing symmetry before and after replacement.
[0020] In the vibration type angular velocity sensor based on the first aspect, preferably, when the temporary offset value before replacement is set to a, the temporary offset value after replacement is set to -a, and the temporary offset value relative to the central value of the sensor output before replacement and the sensor output after replacement is set to b, the offset value before replacement is a+b, and the offset value after replacement is -a+b. If so configured, the offset value is symmetrical relative to b before and after the function as the primary side control circuit and the function as the secondary side control circuit are replaced, so that the control of the vibration type angular velocity sensor before and after replacement can be suppressed from losing symmetry. Moreover, the offset values before and after replacement are symmetrical with respect to the offset value b relative to the central value of the sensor output before and after replacement, so that the control of the vibration type angular velocity sensor before and after replacement can be suppressed from losing symmetry while reducing the gradient of the temperature of the residual bias component relative to the environment. In addition, "temporary" refers to the offset value in the intermediate stage until the final offset value is obtained.
[0021] In the vibration type angular velocity sensor according to the first aspect, it is preferable that, when correcting the sensor output in an analog manner, a first offset value based on the output of the primary side control circuit which is inversely proportional to the temperature change of the gain of the vibrator (in order to correct the sensor output which is inversely proportional to the square of the temperature change of the gain of the vibrator from the secondary side control circuit) and a second offset value based on a constant signal which is not dependent on temperature (in order to correct the sensor output which is inversely proportional to the temperature change of the gain of the vibrator from the secondary side control circuit) are added to the closed control loop of the secondary side control circuit, and the amount of addition of the first offset value and the second offset value is adjusted, thereby correcting the sensor output. Here, when the second offset value based on the constant signal which is not dependent on temperature is added to the closed control loop of the secondary side control circuit, the output of the secondary side control circuit has a characteristic which is inversely proportional to the gain of the vibrator which is dependent on temperature. In addition, the output of the primary-side control circuit also has a characteristic of being inversely proportional to the gain of the oscillator through the feedback action of the closed control loop, so by adding the first offset value based on the output of the primary-side control circuit having the characteristic of being inversely proportional to the gain of the oscillator to the closed control loop of the secondary-side control circuit, the output of the secondary-side control circuit has a characteristic of being inversely proportional to the square of the gain of the oscillator. That is, by adding the first offset value corresponding to the square of the gain of the oscillator and the second offset value corresponding to the first power of the gain of the oscillator, and adjusting the amount of addition of the first offset value and the second offset value, the sensor output is corrected, thereby making it possible to perform a correction inversely proportional to the first power of the gain of the oscillator and a correction inversely proportional to the square of the gain of the oscillator.
[0022] In this case, it is preferable to configure such that the gain dependent on the temperature of the oscillator is G R (T), when A, B, and C are set to constant values that are independent of temperature, the sum of the error in the sensor output generated in the closed control loop of the secondary-side control circuit due to the error signal generated from the circuit block constituting the secondary-side control circuit and the error in the sensor output generated in the closed control loop of the secondary-side control circuit due to the crosstalk from the primary-side control circuit to the secondary-side control circuit is V Out_Total_Error As shown in the following equation, the amount of addition of the first offset value based on the output of the primary-side control circuit which is inversely proportional to the temperature change of the gain of the oscillator is adjusted to reduce the first term of the following equation, i.e., A / G R 2 (T), and adjust the amount of addition of the second offset value based on a constant signal that is independent of temperature to reduce the second term of the following equation, namely, B / G R(T), thereby correcting the sensor output in an analog manner. If so constituted, both the first-order (first-order gain of the oscillator) and second-order (square of the gain of the oscillator) components of the error in the sensor output can be reduced, thereby reliably improving the accuracy of the correction. In addition, although the constant value C remains, C is a constant value that does not depend on temperature, so it does not affect the error in the sensor output caused by temperature changes, and thus there is no problem in the correction.
[0023] [Formula 3]
[0024]
[0025] In the vibration type angular velocity sensor according to the first aspect, it is preferable that, when the sensor output is corrected digitally, the output of the primary side control circuit that is temperature-dependent and inversely proportional to the temperature change of the gain of the vibrator is quantized, and an offset value that reduces the error of the sensor output caused by the temperature change is added to the secondary side control circuit for the quantized output of the primary side control circuit, thereby correcting the sensor output. If so, the sensor output can be corrected only by adding the offset value that reduces the error of the sensor output caused by the temperature change to the secondary side control circuit, so that the structure of the vibration type angular velocity sensor can be simplified, unlike the case where an offset value other than the offset value based on the output of the primary side control circuit that is temperature-dependent is added.
[0026] In the vibration type angular velocity sensor according to the first aspect, preferably, the vibrator includes a ring type vibrator. Here, the ring type vibrator has a symmetrical shape, so the vibration mode based on the primary side control circuit is similar to the vibration mode based on the secondary side control circuit. Therefore, if the present invention is applied to a vibration type angular velocity sensor including a ring type vibrator, there is no need to consider the influence of the difference in vibration modes, so the sensor output can be easily corrected.
[0027] The vibration-type angular velocity sensor based on the second aspect of the present invention comprises: a vibrator; a primary-side control circuit having a closed control loop, the output of which causes the vibrator to cause primary vibration; and a secondary-side control circuit, which detects secondary vibration generated in the vibrator due to the angular velocity applied to the vibrator and has a closed control loop, and is configured to correct the sensor output by adding an offset value to the closed control loop, and is configured to be able to replace the function of causing primary vibration and the function of detecting secondary vibration, and the offset value after replacement and the offset value before replacement are symmetrical values relative to a specified reference value.
[0028] In the vibration type angular velocity sensor according to the second aspect of the present invention, as described above, the function of causing primary vibration and the function of detecting secondary vibration are configured to be replaceable, and the offset value after the replacement and the offset value before the replacement are symmetrical with respect to a prescribed reference value. Thus, before and after the replacement of the function of causing primary vibration and the function of detecting secondary vibration, the offset value is symmetrical with respect to the prescribed reference value, so that the control of the vibration type angular velocity sensor before and after the replacement can be suppressed from losing symmetry. As a result, the temperature variation component of the offset that is not eliminated and remains can be suppressed from increasing.
[0029] In the vibration type angular velocity sensor based on the second aspect, preferably, the primary side control circuit and the secondary side control circuit respectively include a primary side loop filter and a secondary side loop filter in a closed control loop, and are configured to correct the sensor output by adding an offset value to the input of the secondary side loop filter. Here, the output in the closed control loop corresponds to the output of the loop filter. And, the output of the loop filter is inversely proportional to the gain (gain) of the oscillator that depends on the temperature through the feedback action of the closed control loop. In the present invention, focusing on this point, by adding an offset value to the input of the secondary side loop filter, the error caused by crosstalk that is inversely proportional to the first power and / or square of the gain of the oscillator can be reduced.
[0030] In the vibration type angular velocity sensor based on the second aspect, preferably, when the offset value before replacement is set to a, the offset value after replacement is -a in which the polarity of the offset value before replacement is reversed. If so configured, the offset value is symmetrical with respect to zero before and after the function as the primary side control circuit and the function as the secondary side control circuit are replaced, thereby preventing the vibration type angular velocity sensor from losing symmetry before and after replacement.
[0031] In the vibration type angular velocity sensor based on the second aspect, preferably, when the temporary offset value before replacement is set to a, the temporary offset value after replacement is set to -a, and the temporary offset value relative to the central value of the sensor output before replacement and the sensor output after replacement is set to b, the offset value before replacement is a+b, and the offset value after replacement is -a+b. If so configured, the offset value is symmetrical relative to b before and after the function as the primary side control circuit and the function as the secondary side control circuit are replaced, so that the control of the vibration type angular velocity sensor before and after replacement can be suppressed from losing symmetry. In addition, the offset values before and after replacement are symmetrical with respect to the offset value b relative to the central value of the sensor output before and after replacement, so that the control of the vibration type angular velocity sensor before and after replacement can be suppressed from losing symmetry while reducing the gradient of the temperature of the residual bias component relative to the environment. In addition, "temporary" refers to the offset value in the intermediate stage until the final offset value is obtained.
[0032] In the vibration type angular velocity sensor according to the second aspect, it is preferable that, when correcting the sensor output in an analog manner, a first offset value based on the output of the primary side control circuit which is inversely proportional to the temperature change of the gain of the vibrator (in order to correct the sensor output which is inversely proportional to the square of the temperature change of the gain of the vibrator from the secondary side control circuit) and a second offset value based on a constant signal which is not dependent on temperature (in order to correct the sensor output which is inversely proportional to the temperature change of the gain of the vibrator from the secondary side control circuit) are added to the closed control loop of the secondary side control circuit, and the amount of addition of the first offset value and the second offset value is adjusted, thereby correcting the sensor output. Here, when the second offset value based on the constant signal which is not dependent on temperature is added to the closed control loop of the secondary side control circuit, the output of the secondary side control circuit has a characteristic which is inversely proportional to the gain of the vibrator which is dependent on temperature. In addition, the output of the primary-side control circuit also has a characteristic of being inversely proportional to the gain of the oscillator through the feedback action of the closed control loop, so by adding the first offset value based on the output of the primary-side control circuit having the characteristic of being inversely proportional to the gain of the oscillator to the closed control loop of the secondary-side control circuit, the output of the secondary-side control circuit has a characteristic of being inversely proportional to the square of the gain of the oscillator. That is, by adding the first offset value corresponding to the square of the gain of the oscillator and the second offset value corresponding to the first power of the gain of the oscillator, and adjusting the amount of addition of the first offset value and the second offset value, the sensor output is corrected, thereby making it possible to perform a correction inversely proportional to the first power of the gain of the oscillator and a correction inversely proportional to the square of the gain of the oscillator.
[0033] In this case, it is preferable to configure such that the gain dependent on the temperature of the oscillator is G R (T), when A, B, and C are set to constant values that are independent of temperature, the sum of the error in the sensor output generated in the closed control loop of the secondary-side control circuit due to the error signal generated from the circuit block constituting the secondary-side control circuit and the error in the sensor output generated in the closed control loop of the secondary-side control circuit due to the crosstalk from the primary-side control circuit to the secondary-side control circuit is V Out_Total_Error As shown in the following equation, the amount of addition of the first offset value based on the output of the primary-side control circuit which is inversely proportional to the temperature change of the gain of the oscillator is adjusted to reduce the first term of the following equation, i.e., A / G R 2 (T), and adjust the amount of addition of the second offset value based on a constant signal that is independent of temperature to reduce the second term of the following equation, namely, B / G R(T), thereby correcting the sensor output in an analog manner. If so constituted, both the first-order (first-order gain of the oscillator) and second-order (square of the gain of the oscillator) components of the error in the sensor output can be reduced, thereby reliably improving the accuracy of the correction. In addition, although the constant value C remains, C is a constant value that does not depend on temperature, so it does not affect the error in the sensor output caused by temperature changes, and thus there is no problem in the correction.
[0034] [Formula 4]
[0035]
[0036] In the vibration type angular velocity sensor according to the second aspect, it is preferable that, when the sensor output is digitally corrected, the output of the primary side control circuit that is temperature-dependent and inversely proportional to the temperature change of the gain of the vibrator is quantized, and an offset value that reduces the error of the sensor output caused by the temperature change is added to the secondary side control circuit for the quantized output of the primary side control circuit, thereby correcting the sensor output. If so, the sensor output can be corrected only by adding the offset value that reduces the error of the sensor output caused by the temperature change to the secondary side control circuit, so that the structure of the vibration type angular velocity sensor can be simplified, unlike the case where an offset value other than the offset value based on the output of the primary side control circuit that is temperature-dependent is added.
[0037] Effects of the Invention
[0038] According to the present invention, as described above, it is possible to suppress the increase in the temperature variation component of the offset that is not eliminated but remains. BRIEF DESCRIPTION OF THE DRAWINGS
[0039] Figure 1 This is a block diagram showing the structure of the vibration type angular velocity sensor according to the first embodiment.
[0040] Figure 2 This is a diagram for explaining the correction of the sensor output of the vibration type angular velocity sensor according to the first embodiment (with 1 / G R (T) (correction of components proportional to the first power of temperature).
[0041] Figure 3 This is a diagram for explaining the correction of the sensor output of the vibration type angular velocity sensor according to the first embodiment (with 1 / G R 2 (T) (correction of the component proportional to the square of the temperature).
[0042] Figure 4 This is a graph showing the relationship between temperature and bias components.
[0043] Figure 5 This is a diagram showing the relationship between temperature and bias component after the sensor output is corrected based on the offset value.
[0044] Figure 6 (a) is a diagram showing the relationship between temperature and bias component after the sensor output is corrected based on the offset value. Figure 6 (b) is a diagram showing the relationship between temperature and bias component after the sensor output is corrected based on the offset value.
[0045] Figure 7 This is a diagram showing the relationship between temperature and bias component after the sensor output is corrected based on the offset value.
[0046] Figure 8 It is a block diagram showing the structure of a vibration type angular velocity sensor according to the second embodiment.
[0047] Fig. 9 It is a diagram for explaining correction of the sensor output of the vibration type angular velocity sensor according to the second embodiment. DETAILED DESCRIPTION
[0048] Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings.
[0049] (First embodiment)
[0050] First, refer to Figure 1 , a configuration of a vibration type angular velocity sensor 100 according to a first embodiment will be described. In the first embodiment, an example in which calibration is performed by analog processing of a sensor output of the vibration type angular velocity sensor 100 will be described.
[0051] like Figure 1 As shown, the vibration type angular velocity sensor 100 includes: a vibrator 1; a primary side control circuit 2 that drives the vibrator 1 and has a closed control loop; and a secondary side control circuit 3 that detects and outputs the vibration of the vibrator 1 driven by the primary side control circuit 2 and has a closed control loop. Here, in the first embodiment, the vibrator 1 includes a ring type vibrator 1.
[0052] The primary side control circuit 2 includes an amplifier circuit 21, a synchronous detection circuit 22, a loop filter 23, a modulation circuit 24, a drive circuit 25, a PLL (Phase Locked Loop) circuit (phase synchronization circuit) 26 and a reference signal generation circuit 27. In addition, the oscillator 1, the amplifier circuit 21, the synchronous detection circuit 22, the loop filter 23, the modulation circuit 24 and the drive circuit 25 are connected in sequence to form a closed control loop. In addition, the loop filter 23 includes, for example, an integral filter. In addition, the loop filter 23 is an example of a "primary side loop filter" of the technical solution.
[0053] The secondary side control circuit 3 includes an amplifier circuit 31, a synchronous detection circuit 32, an addition circuit 33, a loop filter 34, a modulation circuit 35, a drive circuit 36 and an amplifier circuit 37. In addition, the vibrator 1, the amplifier circuit 31, the synchronous detection circuit 32, the addition circuit 33, the loop filter 34, the modulation circuit 35 and the drive circuit 36 are connected in sequence to form a closed control loop. In addition, the addition circuit 33 is composed of a general addition and subtraction circuit using an operational amplifier. In addition, the loop filter 34 includes, for example, an integration filter. In addition, the output of the loop filter 34 is input to the amplifier circuit 37. In addition, the signal output from the amplifier circuit 37 is output to the outside as the sensor output of the vibration type angular velocity sensor 100. In addition, the loop filter 34 is an example of the "secondary side loop filter" of the technical solution.
[0054] Here, in the first embodiment, the primary-side control circuit 2 and the secondary-side control circuit 3 are configured to be able to switch between the function as the primary-side control circuit 2 and the function as the secondary-side control circuit 3. Specifically, in the primary-side control circuit 2, a switch 41 is provided on the input side of the signal relative to the vibrator 1, and a switch 42 is provided on the output side of the signal relative to the vibrator 1 (the output side of the amplifier circuit 21). Furthermore, in the secondary-side control circuit 3, a switch 43 is provided on the input side of the signal relative to the vibrator 1, and a switch 44 is provided on the output side of the signal relative to the vibrator 1 (the output side of the amplifier circuit 31). The switch 41, the switch 42, the switch 43, and the switch 44 are respectively configured to be able to switch between a state of being connected to the primary-side control circuit 2 and a state of being connected to the secondary-side control circuit 3. Figure 1, the switch 41 and the switch 42 indicate a state of being connected to the primary-side control circuit 2, and the switch 43 and the switch 44 indicate a state of being connected to the secondary-side control circuit 3. Furthermore, by switching the switch 41 and the switch 42 to be connected to the secondary-side control circuit 3, and switching the switch 43 and the switch 44 to be connected to the primary-side control circuit 2, the function as the primary-side control circuit 2 and the function as the secondary-side control circuit 3 can be switched. That is, the vibration type angular velocity sensor 100 is configured so that the function of causing the primary vibration and the function of detecting the secondary vibration can be switched.
[0055] Furthermore, the vibration type angular velocity sensor 100 is provided with addition and subtraction amount adjustment circuits 4a and 4b to which the output from the primary side control circuit 2 (the output from the loop filter 23) is input. The addition and subtraction amount adjustment circuits 4a and 4b are configured to adjust the magnitude of the output of the loop filter 23 of the primary side control circuit 2 that depends on the temperature, and input the adjusted output (temporary first offset value) to the addition circuit 33 of the secondary side control circuit 3. For example, in the addition and subtraction amount adjustment circuits 4a and 4b, the addition amount of the temporary first offset value is adjusted by performing voltage division using a potentiometer (volume resistor) or the like.
[0056] Furthermore, the vibration type angular velocity sensor 100 is provided with an addition and subtraction amount adjustment circuit 5a to which a constant signal S1 not dependent on temperature is input. The addition and subtraction amount adjustment circuit 5a is configured to adjust the magnitude of the constant signal S1 and input the adjusted constant signal S1 (temporary second offset value) to the addition circuit 33 of the secondary side control circuit 3. For example, in the addition and subtraction amount adjustment circuit 5a, the addition amount of the constant signal S1 is adjusted by performing voltage division using a potentiometer (volume resistor) or the like.
[0057] Furthermore, the vibration type angular velocity sensor 100 is provided with an addition and subtraction amount adjustment circuit 5b to which a constant signal S2 not dependent on temperature is input. The addition and subtraction amount adjustment circuit 5b is configured to adjust the magnitude of the constant signal S2 and input the adjusted constant signal S2 (temporary second offset value) to the addition circuit 33 of the secondary side control circuit 3. For example, in the addition and subtraction amount adjustment circuit 5b, the addition amount of the constant signal S2 is adjusted by performing voltage division using a potentiometer (volume resistor) or the like.
[0058] Here, in the first embodiment, when correcting the sensor output in an analog manner, a first offset value based on the output of the primary-side control circuit 2 (the output of the loop filter 23) which is inversely proportional to the temperature change of the gain of the oscillator 1 (in order to correct the sensor output which is inversely proportional to the square of the temperature change of the gain of the oscillator 1 from the secondary-side control circuit 3) and a second offset value based on a constant signal which is independent of temperature (in order to correct the sensor output which is inversely proportional to the temperature change of the gain of the oscillator 1 from the secondary-side control circuit 3) are added to the closed control loop of the secondary-side control circuit 3 (the input of the loop filter 34 of the secondary-side control circuit 3), and the addition amount of the first offset value and the addition amount of the second offset value are adjusted by the addition and subtraction amount adjustment circuits 4a and 4b and the addition and subtraction amount adjustment circuits 5a and 5b, respectively, thereby correcting the sensor output (the output from the secondary-side control circuit 3). Furthermore, a first offset value and a second offset value are determined and added to reduce an error in the sensor output generated in the closed control loop of the secondary side control circuit 3 due to an erroneous signal generated from a circuit block constituting the secondary side control circuit 3 and an error in the sensor output generated in the closed control loop of the secondary side control circuit 3 due to crosstalk (signal crossing) from the primary side control circuit 2 to the secondary side control circuit 3, thereby correcting the sensor output.
[0059] Furthermore, in the first embodiment, the offset values (the first offset value and the second offset value) after the replacement and the offset values before the replacement are symmetrical with respect to the prescribed reference value. In other words, the absolute value of the difference between the offset value added to the closed control loop before the replacement and the prescribed reference value and the absolute value of the difference between the offset value added to the closed control loop after the replacement and the prescribed reference value are configured to be substantially equal.
[0060] Specifically, in the first embodiment, when the temporary offset value before replacement is set to a, the temporary offset value after replacement is set to -a, and the temporary offset value relative to the central value of the sensor output before replacement and the sensor output after replacement is set to b, the offset value before replacement is a+b, and the offset value after replacement is -a+b. In addition, the temporary offset value a refers to the temporary first offset value a1 described later and the temporary second offset value a2 described later. And, the temporary offset value b refers to the temporary first offset value b1 described later and the temporary second offset value b2 described later. In addition, the temporary offset value b relative to the central value is an example of the "prescribed reference value" of the technical solution.
[0061] In detail, Figure 1As shown in FIG. 1 , an addition / subtraction amount adjustment circuit 4a and an addition / subtraction amount adjustment circuit 4b are provided on the output side of the primary side control circuit 2. An inverter circuit 51 and a switch 52 are provided on the output side of the addition / subtraction amount adjustment circuit 4a. The switch 52 is configured to switch between a state connected to the addition / subtraction amount adjustment circuit 4a and a state connected to the inverter circuit 51. Figure 1 As shown, when the switch 52 is connected to the addition and subtraction amount adjustment circuit 4a, the output (a1) from the addition and subtraction amount adjustment circuit 4a and the output (b1) from the addition and subtraction amount adjustment circuit 4b are input to the addition circuit 33. That is, a1+b1 is added to the secondary side control circuit 3 as the first offset value. And, when the switch 52 is connected to the inverter circuit 51, the output (-a1) from the inverter circuit 51 and the output (b1) from the addition and subtraction amount adjustment circuit 4b are input to the addition circuit 33. That is, -a1+b1 is added to the secondary side control circuit 3 as the first offset value. In addition, the method of obtaining a1 and b1 will be described later.
[0062] Furthermore, a NOT circuit 45 and a switch 46 are provided on the output side of the addition / subtraction amount adjustment circuit 5b. The switch 46 is configured to switch between a state connected to the addition / subtraction amount adjustment circuit 5b and a state connected to the NOT circuit 45. Figure 1 As shown, when the switch 46 is connected to the addition and subtraction amount adjustment circuit 5b, the output (a2) from the addition and subtraction amount adjustment circuit 5b and the output (b2) from the addition and subtraction amount adjustment circuit 5a are input to the addition circuit 33. That is, a2+b2 is added to the secondary side control circuit 3 as the second offset value. And, when the switch 46 is connected to the NOT circuit 45, the output (-a2) from the NOT circuit 45 and the output (b2) from the addition and subtraction amount adjustment circuit 5a are input to the addition circuit 33. That is, -a2+b2 is added to the secondary side control circuit 3 as the second offset value. In addition, the method of obtaining a2 and b2 will be described later.
[0063] (Structure without changing function)
[0064] Next, refer to Figure 1 The following describes in detail the correction of the sensor output of the vibration type angular velocity sensor 100. The following describes a case where the function as the primary side control circuit 2 and the function as the secondary side control circuit 3 are not replaced (ie, the structure of Japanese Patent No. 6463335).
[0065] First, the output error of the vibration type angular velocity sensor 100 as the object of correction is described. As the output error of the vibration type angular velocity sensor 100, there are errors in the sensor output of the vibration type angular velocity sensor 100 caused by the error signal generated from the circuit block constituting the secondary side control circuit 3 and errors in the sensor output of the vibration type angular velocity sensor 100 caused by the influence (crosstalk) from the primary side control circuit 2. It is assumed that the component (error component) of the error signal generated from the circuit block constituting the secondary side control circuit 3 is a constant value that does not have temperature dependence. In addition, usually, in the feedback circuit (feedback circuit), the output signal from each circuit is represented by a value obtained by dividing the input signal input to each circuit by the feedback gain (output signal = input signal × 1 / (feedback gain)).
[0066] As described in Japanese Patent No. 6463335, the sum of the error in the sensor output generated in the closed control loop of the secondary-side control circuit 3 due to the error signal generated from the circuit block constituting the secondary-side control circuit 3 and the error in the sensor output generated in the closed control loop of the secondary-side control circuit 3 due to the crosstalk from the primary-side control circuit 2 to the secondary-side control circuit 3 is V. Out_Total_Error It is represented by the following equation 5. In addition, A, B, and C are constant values (coefficients) that do not depend on temperature.
[0067] [Formula 5]
[0068]
[0069] Next, the error V of the sensor output of the vibration type angular velocity sensor 100 represented by the above equation 5 will be described in detail. Out_Total_Error , to correct the sensor output in an analog manner.
[0070] First, the V based on a constant signal that does not depend on temperature In_Const_Corr The (second offset value) is added to the input (path 2) of the loop filter 34 of the secondary-side control circuit 3. At this time, the sensor output V of the vibration angular velocity sensor 100 is Out_Const_Corr It is expressed by the following formula 6.
[0071] [Formula 6]
[0072]
[0073] Here, when the second offset value based on the constant signal that does not depend on the temperature is added to the input of the loop filter 34, as shown in the above equation 6, the sensor output V Out_Const_Corr becomes with the temperature-dependent gain G R(T). In addition, p in the above equation 6 is a constant value. And, V is adjusted by the addition and subtraction amount adjustment circuit 5a. In_Const_Corr (second offset value) so that p in the above equation 6 and the second term in the above equation 5, i.e., B / G R (T) and B are equal in magnitude (p = -B), thus eliminating the second term of the above equation 5, namely B / G R That is, by adjusting the second offset value based on a constant signal that is not dependent on temperature and adding it to the input of the loop filter 34, the gain G dependent on temperature in the above formula 5 can be eliminated. R A term that is inversely proportional to the square of (T).
[0074] Also, the output V of the loop filter 23 of the primary side control circuit 2 depends on the temperature. AGC It is expressed by the following equation 7. In addition, the output V of the loop filter 23 is AGC The output of the loop filter 23 in consideration of the closed control loop becomes a value dependent on temperature.
[0075] [Formula 7]
[0076]
[0077] Here, in the simulation calibration according to the first embodiment, in addition to the above-mentioned V based on the constant signal that does not depend on temperature, In _ Const_Corr (2nd offset value), it will also be multiplied by the output V AGC The value obtained by adjusting the ratio q of the first offset value (first offset value) is added to the input (path 2) of the loop filter 34 of the secondary-side control circuit 3. The sensor output V of the vibration angular velocity sensor 100 when the first offset value is added is Out_AGC_Corr It is expressed by the following formula 8.
[0078] [Formula 8]
[0079]
[0080] Here, when the first offset value based on the output of the primary-side control circuit 2 that depends on the temperature is added to the input of the loop filter 34, as shown in the above equation 8, the sensor output V Out_AGC_Corr becomes with the temperature-dependent gain G R (T) is inversely proportional to the square of (T). In addition, r in the above formula 8 is a constant value. And, q is adjusted by the addition and subtraction amount adjustment circuit 4b so that r in the above formula 8 is equal to the value including G in the above formula 5. R A / G of the first term of the square of (T) R 2(T) and A are equal in magnitude (r = -A), thus eliminating the first term of the above equation 5, i.e., A / G R 2 That is, the sensor output of the vibration type angular velocity sensor 100 becomes a value obtained by adding the error represented by the above formula 5 to the original sensor output when the sensor output is not corrected. On the other hand, in the first embodiment, by adding the first offset value and the second offset value, the sensor output of the vibration type angular velocity sensor 100 becomes a value obtained by adding the constant value C to the original sensor output.
[0081] In addition, C in Formula 5 is a constant value that does not depend on temperature, so there is no problem in terms of calibration. In addition, the coefficients A, B, and C in the above Formula 5 are calculated as follows: the sensor output of the vibration type angular velocity sensor 100 before calibration (before compensation) at each temperature is measured (actually measured), and the measured data is polynomially approximated by the least square method. In addition, the calculation of the coefficients A, B, and C is performed for each vibration type angular velocity sensor 100 (each product).
[0082] As described above, the amount of addition of the first offset value based on the output of the primary-side control circuit 2 that depends on the temperature is adjusted so that the first term of Formula 5, i.e., A / G R 2 (T)(with temperature-dependent gain G R The term inversely proportional to the square of (T)) becomes 0, and the amount of addition of the second offset value based on the constant signal that does not depend on the temperature is adjusted so that the second term of Formula 5, that is, B / G R (T)(with temperature-dependent gain G R (T) The inversely proportional term) becomes 0, and the sensor output is corrected in an analog manner.
[0083] That is, Figure 2 As shown, by adding the second offset value based on a constant signal that does not depend on temperature, 1 / G of the error in the sensor output of the vibration type angular velocity sensor 100 can be eliminated. R (T) proportional (temperature dependent gain G R (T)) component (the second term of Formula 5), thus the sensor output ( Figure 2 The dotted line) becomes approximately constant ( Figure 2 However, if Figure 3 As shown in Figure 2, even if the sensor output is set to be approximately constant, it has a temperature-dependent characteristic at the microscopic level ( Figure 3Therefore, by adding the first offset value based on the output of the primary-side control circuit 2 which depends on the temperature, the 1 / G difference with the sensor output of the vibration type angular velocity sensor 100 can be eliminated. R 2 (T) proportional (temperature dependent gain G R The sensor output becomes approximately constant and independent of temperature ( Figure 3 As a result, the accuracy of the correction can be improved. Furthermore, when the sensor output of the vibration type angular velocity sensor 100 is corrected in an analog manner, unlike the case where the correction is performed in a digital manner (the signal is a discrete value), the signal is a continuous value, so it is possible to suppress the sensor output of the vibration type angular velocity sensor 100 from becoming a step-like shape (the sensor output is set to a continuous value).
[0084] (Structure of replacement function)
[0085] Next, the offset value of the first embodiment configured to be able to switch between the function as the primary-side control circuit 2 and the function as the secondary-side control circuit 3 will be described.
[0086] like Figure 4 As shown in FIG. 1 , in general, in the vibration type angular velocity sensor 100, the bias component (vertical axis) of the angular velocity detected by the vibration type angular velocity sensor 100 changes with respect to the change in temperature (horizontal axis). Also, the change in the bias component before switching the function as the primary side control circuit 2 and the function as the secondary side control circuit 3 ( Figure 4 P) and the change of the bias component after replacement ( Figure 4 And, if Figure 5 As shown, before replacement, the first offset value and the second offset value are added to eliminate the first and second terms of the above formula 5, thereby the temperature change of the sensor output ( Figure 5 After the replacement, the first offset value and the second offset value are added to eliminate the first and second terms of the above formula 5, thereby the temperature change of the sensor output ( Figure 5 The S) becomes smaller. In addition, Figure 5 The P of S is relative to the line segment along the horizontal axis ( Figure 5 The single dot-dash line) is asymmetric, so Figure 5 The temperature variation component of the difference between P and S does not become zero. As described above, before and after the replacement, the first offset value and the second offset value are determined separately to eliminate the first and second terms of the above formula 5, Figure 5 The temperature variation component of the difference between P and S will not become zero.
[0087] Therefore, if Figure 6As shown in (a), before and after the replacement, the temporary first offset value a1 and the temporary second offset value a2 are determined so as to minimize the differential temperature change component, and the polarity of the offset value is reversed before and after the replacement. In addition, when the temporary first offset value a1 and the temporary second offset value a2 are used before the replacement, the first and second terms of the above formula 5 are not eliminated, so the bias component has a gradient with respect to the temperature in the state before the replacement. Similarly, when the temporary first offset value -a1 and the temporary second offset value -a2 are used after the replacement, the first and second terms of the above formula 5 are not eliminated, so the bias component has a gradient with respect to the temperature in the state after the replacement.
[0088] Therefore, if Figure 6 As shown in (b), the change in the bias component before switching the function as the primary side control circuit 2 and the function as the secondary side control circuit 3 ( Figure 4 P) and the change of the bias component after replacement ( Figure 4 The central value of S Figure 4 M), determine the temporary first offset value b1 and the temporary second offset value b2 to eliminate the first and second terms of the above formula 5. And, the first offset value before replacement is set to a1+b1, the second offset value is set to a2+b2, the first offset value after replacement is set to -a1+b1, and the second offset value is set to -a2+b2. Thus, before and after replacement, the first offset value is symmetrical with the temporary first offset value b1 relative to the central value, and the second offset value is symmetrical with the temporary second offset value b2 relative to the central value. As a result, as Figure 7 As shown in the figure, the change of the bias component before replacement ( Figure 7 P) and the change in bias component after replacement ( Figure 7 The temperature gradient becomes smaller in the S). As a result, it is possible to reduce Figure 7 The difference between P and S (residue of the bias component) is reduced while the temperature gradient of the bias component is reduced.
[0089] (Effects of the First Embodiment)
[0090] In the first embodiment, the following effects can be obtained: In the following, the Q value (a dimensionless number indicating a vibration state) is described as a value having a characteristic that is substantially inversely proportional to the temperature.
[0091] In the first embodiment, as described above, the primary-side control circuit 2 and the secondary-side control circuit 3 are configured so that the function as the primary-side control circuit 2 and the function as the secondary-side control circuit 3 can be switched, and the offset value after the switch and the offset value before the switch are symmetrical with respect to a predetermined reference value. Thus, before and after the switch of the function as the primary-side control circuit 2 and the function as the secondary-side control circuit 3, the offset value is symmetrical with respect to the predetermined reference value, so that the control of the vibration type angular velocity sensor 100 before and after the switch can be prevented from losing symmetry. As a result, the temperature variation component of the offset that is not eliminated and remains can be prevented from increasing.
[0092] Furthermore, in the first embodiment, as described above, the primary-side control circuit 2 and the secondary-side control circuit 3 include the loop filter 23 and the loop filter 34, respectively, in the closed control loop, and are configured to correct the sensor output by adding an offset value to the input of the loop filter 34. Here, the output in the closed control loop corresponds to the output of the loop filter. Furthermore, the output of the loop filter is inversely proportional to the gain (gain) of the oscillator 1 that depends on the temperature through the feedback action of the closed control loop. In the first embodiment, focusing on this point, by adding an offset value to the input of the loop filter 34, the error caused by crosstalk that is inversely proportional to the first power and / or square of the gain of the oscillator 1 can be reduced.
[0093] Furthermore, in the first embodiment, as described above, when the offset value before replacement is set to a, the offset value after replacement is -a in which the polarity of the offset value before replacement is reversed. Thus, the offset value is symmetrical with respect to zero before and after the function as the primary-side control circuit 2 and the function as the secondary-side control circuit 3 are replaced, so that the control of the vibration type angular velocity sensor 100 before and after replacement can be prevented from losing symmetry.
[0094] Furthermore, in the first embodiment, as described above, when the temporary offset value before replacement is set to a, the temporary offset value after replacement is set to -a, and the temporary offset value relative to the central value of the sensor output before replacement and the sensor output after replacement is set to b, the offset value before replacement is a+b, and the offset value after replacement is -a+b. Thus, before and after the function as the primary-side control circuit 2 and the function as the secondary-side control circuit 3 are replaced, the offset value is symmetrical relative to b, so it is possible to suppress the loss of symmetry in the control of the vibration type angular velocity sensor 100 before and after replacement. Furthermore, the offset values before and after replacement are symmetrical with respect to the offset value b relative to the central value of the sensor output before and after replacement, so it is possible to suppress the loss of symmetry in the control of the vibration type angular velocity sensor 100 before and after replacement while reducing the gradient of the residual bias component relative to the temperature of the environment.
[0095] Furthermore, in the first embodiment, as described above, when correcting the sensor output in an analog manner, the first offset value based on the output of the primary-side control circuit 2 inversely proportional to the temperature change of the gain of the oscillator 1 (in order to correct the sensor output inversely proportional to the square of the temperature change of the gain of the oscillator 1 from the secondary-side control circuit 3) and the second offset value based on a constant signal not dependent on temperature (in order to correct the sensor output inversely proportional to the temperature change of the gain of the oscillator 1 from the secondary-side control circuit 3) are added to the closed control loop of the secondary-side control circuit 3, and the amount of addition of the first offset value and the second offset value is adjusted, thereby correcting the sensor output. Here, when the second offset value based on the constant signal not dependent on temperature is added to the closed control loop of the secondary-side control circuit 3, the output of the secondary-side control circuit 3 has a characteristic inversely proportional to the gain of the oscillator 1 that depends on the temperature. Furthermore, the output of the primary-side control circuit 2 also has a characteristic inversely proportional to the gain of the vibrator 1 through the feedback action of the closed control loop, and therefore, by adding the first offset value based on the output of the primary-side control circuit 2 having a characteristic inversely proportional to the gain of the vibrator 1 to the closed control loop of the secondary-side control circuit 3, the output of the secondary-side control circuit 3 has a characteristic inversely proportional to the square of the gain of the vibrator 1. That is, by adding the first offset value corresponding to the square of the gain of the vibrator 1 and the second offset value corresponding to the first power of the gain of the vibrator 1, and adjusting the amount of addition of the first offset value and the second offset value, the sensor output is corrected, thereby making it possible to perform a correction inversely proportional to the first power of the gain of the vibrator 1 and a correction inversely proportional to the square of the gain of the vibrator 1.
[0096] Furthermore, in the first embodiment, as described above, when the gain dependent on the temperature of the vibrator 1 is G R (T), when A, B, and C are set to constant values that are independent of temperature, the sum of the error in the sensor output generated in the closed control loop of the secondary-side control circuit 3 due to the error signal generated from the circuit block constituting the secondary-side control circuit 3 and the error in the sensor output generated in the closed control loop of the secondary-side control circuit 3 due to the crosstalk from the primary-side control circuit 2 to the secondary-side control circuit 3 is V Out_Total_Error As shown in the above equation 5, the amount of addition of the first offset value based on the output of the primary-side control circuit 2 which is inversely proportional to the temperature change of the gain of the oscillator 1 is adjusted to reduce the first term of the above equation 5, i.e., A / G R 2 (T), and adjust the amount of addition of the second offset value based on a constant signal that is not dependent on temperature to reduce the second term of the above formula 5, that is, B / G R(T), thereby correcting the sensor output in an analog manner. As a result, both the first-order (first-order gain of the vibrator 1) and second-order (square of the gain of the vibrator 1) components of the sensor output error can be reduced, so the accuracy of the correction can be reliably improved. In addition, although the constant value C remains, C is a constant value that does not depend on temperature, so it will not affect the error of the sensor output caused by temperature changes, and thus there is no problem in the correction.
[0097] Furthermore, in the first embodiment, as described above, the vibrator 1 includes the ring-type vibrator 1. Here, the ring-type vibrator 1 has a symmetrical shape, so the vibration mode based on the primary-side control circuit 2 is similar to the vibration mode based on the secondary-side control circuit 3. Therefore, if the present invention is applied to the vibration-type angular velocity sensor 100 including the ring-type vibrator 1, there is no need to consider the influence of the difference in vibration modes, so the sensor output can be easily corrected.
[0098] Furthermore, in the first embodiment, as described above, the vibration type angular velocity sensor 100 is configured to be able to replace the function of causing primary vibration and the function of detecting secondary vibration, and the offset value after the replacement and the offset value before the replacement are symmetrical with respect to a predetermined reference value. Thus, before and after the replacement of the function of causing primary vibration and the function of detecting secondary vibration, the offset value is symmetrical with respect to the predetermined reference value, so that the control of the vibration type angular velocity sensor 100 before and after the replacement can be suppressed from losing symmetry. As a result, it is possible to suppress the increase of the temperature variation component of the offset that is not eliminated and remains.
[0099] (Second embodiment)
[0100] Next, refer to Figure 8 The structure of the vibration type angular velocity sensor 101 according to the second embodiment will be described. In the second embodiment, an example in which correction is performed by digitally processing the output of the loop filter 23 of the primary side control circuit 2 will be described.
[0101] like Figure 8 As shown, the vibration type angular velocity sensor 101 includes a vibrator 1, a primary side control circuit 2, a secondary side control circuit 3, an AD conversion circuit 6, a correction operation processing unit 7, and a DA conversion circuit 8. The structures of the vibrator 1, the primary side control circuit 2, and the secondary side control circuit 3 are different from those of the first embodiment.
[0102] Also, similarly to the first embodiment, the primary-side control circuit 2 and the secondary-side control circuit 3 are configured to be able to switch between the function of the primary-side control circuit 2 and the function of the secondary-side control circuit 3. Specifically, in the primary-side control circuit 2, a switch 41 is provided on the input side of the signal with respect to the vibrator 1, and a switch 42 is provided on the output side of the signal with respect to the vibrator 1 (the output side of the amplifier circuit 21). Also, in the secondary-side control circuit 3, a switch 43 is provided on the input side of the signal with respect to the vibrator 1, and a switch 44 is provided on the output side of the signal with respect to the vibrator 1 (the output side of the amplifier circuit 31).
[0103] Furthermore, the AD conversion circuit 6 is configured to input the temperature-dependent analog signal output from the loop filter 23 of the primary-side control circuit 2, convert (quantize) the analog signal into a digital signal, and output it to the correction operation processing unit 7. Furthermore, in the second embodiment, the correction operation processing unit 7 is configured to output an offset value that reduces the error of the sensor output caused by the temperature change to the quantized output of the primary-side control circuit 2 (the output from the AD conversion circuit 6) to the DA conversion circuit 8. Furthermore, the DA conversion circuit 8 is configured to convert the offset value into an analog signal and add it to the input of the loop filter 34 of the secondary-side control circuit 3. Thus, the vibration type angular velocity sensor 101 is configured to perform correction of the sensor output.
[0104] Next, refer to Figure 8 and Fig. 9 , the case of digitally correcting the sensor output is specifically described.
[0105] First, by scanning (changing to various values) the offset value (correction value) input to the adding circuit 33 of the secondary side control circuit 3, while measuring the sensor output of the vibration type angular velocity sensor 101, in the same manner as the first embodiment described above, the temperature variation component of the offset (difference before and after replacement) is minimized before and after replacement, and the polarity of the offset value is reversed before and after replacement, and the temperature (T1, T2, etc., reference numeral 1) is searched before and after replacement. Fig. 9 ) under the offset value (y1, y2..., refer to Fig. 9 ). Then, the error of the sensor output of the vibration type angular velocity sensor 101 (the error corresponding to the error specified by the above formula 5) becomes 0 or approximately 0 at each temperature (T1, T2, etc., reference Fig. 9 ) under the offset value (z1, z2..., refer to Fig. 9 ).
[0106] Next, the quantized output from the primary side control circuit 2 (loop filter 23) at each temperature is set as x, and the offset value at which the residual of the temperature variation component of the offset (difference before and after replacement) becomes the smallest is set as y, and the least square method is used to calculate the value of Fig. 9 The data shown is subjected to polynomial approximation to obtain (calculate) the following equation 9 (l, m, n are coefficients of constant values). In the second embodiment, as shown in the following equation 9, a quadratic polynomial is used.
[0107] [Formula 9]
[0108] y=lx 2 +mx+n
[0109] Similarly, assuming that the quantized output from the primary-side control circuit 2 (loop filter 23) at each temperature is x, the following equation 10 is obtained as an offset value with respect to the central value of the bias component before and after the replacement.
[0110] [Formula 10]
[0111] z=lx 2 +mx+n
[0112] As a result, the relationship between the offset value at each temperature and the output of the primary side control circuit 2 quantized at each temperature (Formula 9 and Formula 10) is obtained in advance (before the vibration type angular velocity sensor 101 is actually used). In addition, the calculation of the relationship is performed for each vibration type angular velocity sensor 101 (each product). And, in the case of actually using the vibration type angular velocity sensor 101, in the vibration type angular velocity sensor 101, the output (x) of the primary side control circuit 2 quantized is calculated by software in the correction operation processing unit 7 using the above formula 9 and formula 10, and the obtained offset value (y+z before replacement, -y+z after replacement) is added to the secondary side control circuit 3, thereby performing correction. That is, in the case of digitally correcting the sensor output, the relationship (Formula 9 and Formula 10) is always used for calculation, and correction is always performed corresponding to the output of the primary side control circuit 2 quantized.
[0113] In the second embodiment, the following effects can be obtained.
[0114] In the second embodiment, as described above, when the sensor output is digitally corrected, the output of the primary-side control circuit 2 that is temperature-dependent and inversely proportional to the temperature change of the gain of the vibrator 1 is quantized, and the sensor output is corrected by adding an offset value that reduces the error of the sensor output caused by the temperature change to the quantized output of the primary-side control circuit 2 to the secondary-side control circuit 3. Thus, the sensor output can be corrected only by adding the offset value that reduces the error of the sensor output caused by the temperature change to the secondary-side control circuit 3. Therefore, unlike the case where an offset value other than the offset value based on the output of the primary-side control circuit 2 that is temperature-dependent is added, the structure of the vibration type angular velocity sensor 101 can be simplified.
[0115] The embodiments disclosed this time should be considered to be illustrative in all respects and not restrictive. The scope of the present invention is indicated by the claims rather than the description of the embodiments described above, and includes all modifications within the meaning and scope equivalent to the claims.
[0116] For example, in the first and second embodiments, an example of using a ring-shaped vibrator is shown, but the present invention is not limited thereto. For example, the vibrator may have a symmetrical shape, and a disc-shaped, cup-shaped (wine glass-shaped), octagonal-shaped, etc. vibrator may be used.
[0117] Furthermore, in the first and second embodiments described above, an example is shown in which a closed control loop is formed by an oscillator, an amplifier circuit, a synchronous detection circuit, a loop filter, a modulation circuit, and a drive circuit, but the present invention is not limited thereto. For example, the control loop may be formed by a structure other than the structure including the amplifier circuit, the synchronous detection circuit, the loop filter, the modulation circuit, and the drive circuit.
[0118] Furthermore, in the above-mentioned first embodiment and second embodiment, an example in which an integrating filter is used as a loop filter is shown, but, for example, a loop filter other than an integrating filter may be used.
[0119] Furthermore, in the first embodiment described above, an example is shown in which the first offset value before replacement is a1+b1 and the second offset value is a2+b2, and the first offset value after replacement is -a1+b1 and the second offset value is -a2+b2, but the present invention is not limited to this. For example, the first offset value before replacement may be a1 and the second offset value may be a2, the first offset value after replacement may be -a1, which is the polarity of the first offset value a1 before replacement and is reversed, and the second offset value after replacement may be -a2, which is the polarity of the second offset value a2 before replacement and is reversed. Thus, before and after the function as the primary-side control circuit 2 and the function as the secondary-side control circuit 3 are replaced, although a certain degree of residue of the temperature variation component of the offset remains, the first offset value for performing the correction inversely proportional to the square of the gain of the vibrator 1 and the second offset value for performing the correction inversely proportional to the first power of the gain of the vibrator 1 are symmetrical with respect to zero (predetermined reference value), so that the control of the vibration type angular velocity sensor before and after replacement can be prevented from losing symmetry.
[0120] Furthermore, in the first embodiment described above, an example is shown in which the first offset value before replacement is a1+b1 and the second offset value is a2+b2, and the first offset value after replacement is -a1+b1 and the second offset value is -a2+b2, but the present invention is not limited to this. For example, a configuration may be made such that the central value is determined so as to eliminate the first term of the above-mentioned formula 5 (that is, the first offset value is fixed by b1), the second offset value before replacement is a2+b2, and the second offset value after replacement is -a2+b2. That is, only the second offset value may be a value that is symmetrical with respect to a predetermined reference value before and after replacement.
[0121] Furthermore, in the first embodiment and the second embodiment described above, the following example is shown, that is, before and after replacement, the temporary first offset value a1 and the temporary second offset value a2 before and after replacement are determined so as to minimize the residual of the offset component, but the present invention is not limited to this. For example, before and after replacement, the first offset value and the second offset value before and after replacement may be determined so as to be values near the value at which the residual of the offset component becomes the minimum.
[0122] Furthermore, in the first embodiment described above, an example is shown in which the addition and subtraction amount adjustment circuits 4a and 4b and the addition and subtraction amount adjustment circuits 5a and 5b (four separate circuits) are provided to output the offset value a+b and the offset value -a+b, but the present invention is not limited thereto. In the present invention, a circuit that outputs a signal equivalent to the offset value a+b and the offset value -a+b may be provided.
[0123] Explanation of symbols
[0124] 1- oscillator, 2- primary side control circuit, 3- secondary side control circuit, 23- loop filter (primary side loop filter), 34- loop filter (secondary side loop filter), 100, 101- vibration type angular velocity sensor.
Claims
1. A vibration type angular velocity sensor, comprising: Vibrator; a primary-side control circuit having a closed control loop, wherein an output of the closed control loop causes the vibrator to cause primary vibration; and a secondary-side control circuit that detects secondary vibration generated in the vibrator due to an angular velocity applied to the vibrator and has a closed control loop, and is configured to correct the sensor output by adding an offset value to the closed control loop, The primary-side control circuit and the secondary-side control circuit are configured to be able to switch between a function as the primary-side control circuit and a function as the secondary-side control circuit. The offset value after replacement and the offset value before replacement are symmetrical values relative to a prescribed reference value, When the offset value before replacement is set to a, the offset value after replacement is -a in which the polarity of the offset value before replacement is reversed. Alternatively, when the temporary offset value before replacement is set to a, the temporary offset value after replacement is set to -a, and the temporary offset value relative to the central value of the sensor output before replacement and the sensor output after replacement is set to b, The offset value before replacement is a+b, and the offset value after replacement is -a+b.
2. The vibration type angular velocity sensor according to claim 1, wherein: The primary-side control circuit and the secondary-side control circuit respectively include a primary-side loop filter and a secondary-side loop filter in the closed control loop, The sensor output is corrected by adding the offset value to the input of the secondary-side loop filter.
3. The vibration type angular velocity sensor according to claim 1, wherein when the sensor output is corrected in an analog manner, a first offset value based on the output of the primary side control circuit which is inversely proportional to the temperature change of the gain of the vibrator and a second offset value based on a constant signal which is independent of temperature are added to a closed control loop of the secondary side control circuit, and an addition amount of the first offset value and the second offset value is adjusted, thereby correcting the sensor output, wherein: The first offset value is a value for correcting the sensor output inversely proportional to the square of the temperature change of the gain of the oscillator from the secondary side control circuit, and the second offset value is a value for correcting the sensor output inversely proportional to the temperature change of the gain of the oscillator from the secondary side control circuit.
4. The vibration type angular velocity sensor according to claim 3, wherein the gain dependent on the temperature of the vibrator is G R(T), when A, B and C are set to constant values that are independent of temperature, the sum of the error in the sensor output generated in the closed control loop of the secondary-side control circuit due to the error signal generated from the circuit block constituting the secondary-side control circuit and the error in the sensor output generated in the closed control loop of the secondary-side control circuit due to the crosstalk from the primary-side control circuit to the secondary-side control circuit is V Out_Total_Error As shown in the following equation, the amount of addition of the first offset value based on the output of the primary-side control circuit that is temperature-dependent and inversely proportional to the temperature change of the gain of the oscillator is adjusted to reduce the first term of the following equation, i.e., A / G R 2 (T), and adjust the amount of addition of the second offset value based on the constant signal that is not dependent on temperature to reduce the second term of the following equation, namely, B / G R (T), thereby performing a correction simulating the output of the sensor, [Formula 1] 5. The vibration type angular velocity sensor according to claim 1 is constructed such that, when the sensor output is digitally corrected, the output of the primary side control circuit that depends on the temperature and is inversely proportional to the temperature change of the gain of the vibrator is quantized, and for the quantized output of the primary side control circuit, the offset value that reduces the error of the sensor output caused by the temperature change is added to the secondary side control circuit, thereby correcting the sensor output.
6. The vibration type angular velocity sensor according to claim 1, wherein: The vibrator includes a ring-type vibrator.
7. A vibration type angular velocity sensor, comprising: Vibrator; a primary-side control circuit having a closed control loop, wherein an output of the closed control loop causes the vibrator to cause primary vibration; and a secondary-side control circuit that detects secondary vibration generated in the vibrator due to an angular velocity applied to the vibrator and has a closed control loop, and is configured to correct the sensor output by adding an offset value to the closed control loop, and is configured to be able to replace the function of causing the primary vibration and the function of detecting the secondary vibration, The offset value after replacement and the offset value before replacement are symmetrical values relative to a prescribed reference value, When the offset value before replacement is set to a, the offset value after replacement is -a in which the polarity of the offset value before replacement is reversed. Alternatively, when the temporary offset value before replacement is set to a, the temporary offset value after replacement is set to -a, and the temporary offset value relative to the central value of the sensor output before replacement and the sensor output after replacement is set to b, The offset value before replacement is a+b, and the offset value after replacement is -a+b.
8. The vibration type angular velocity sensor according to claim 7, wherein: The primary-side control circuit and the secondary-side control circuit respectively include a primary-side loop filter and a secondary-side loop filter in the closed control loop, The sensor output is corrected by adding the offset value to the input of the secondary-side loop filter.
9. The vibration type angular velocity sensor according to claim 7, wherein when the sensor output is corrected in an analog manner, a first offset value based on the output of the primary side control circuit which is inversely proportional to the temperature change of the gain of the vibrator and a second offset value based on a constant signal which is independent of temperature are added to a closed control loop of the secondary side control circuit, and the addition amount of the first offset value and the second offset value is adjusted, thereby correcting the sensor output, wherein: The first offset value is a value for correcting the sensor output inversely proportional to the square of the temperature change of the gain of the oscillator from the secondary side control circuit, and the second offset value is a value for correcting the sensor output inversely proportional to the temperature change of the gain of the oscillator from the secondary side control circuit.
10. The vibration type angular velocity sensor according to claim 9, wherein the gain dependent on the temperature of the vibrator is G R (T), when A, B and C are set to constant values that are independent of temperature, the sum of the error in the sensor output generated in the closed control loop of the secondary-side control circuit due to the error signal generated from the circuit block constituting the secondary-side control circuit and the error in the sensor output generated in the closed control loop of the secondary-side control circuit due to the crosstalk from the primary-side control circuit to the secondary-side control circuit is V Out_Total_Error The first term of the following equation, A / GR, is expressed by adjusting the amount of addition of the first offset value based on the output of the primary-side control circuit that is temperature-dependent and inversely proportional to the temperature change of the gain of the oscillator to reduce: 2 (T), and adjust the amount of addition of the second offset value based on the constant signal that is not dependent on temperature to reduce the second term of the following equation, namely, B / G R (T), thereby performing a correction simulating the output of the sensor, [Formula 2] 11. The vibration type angular velocity sensor according to claim 7 is constructed such that, when the sensor output is digitally corrected, the output of the primary side control circuit which depends on the temperature and is inversely proportional to the temperature change of the gain of the vibrator is quantized, and for the quantized output of the primary side control circuit, the offset value which reduces the error of the sensor output caused by the temperature change is added to the secondary side control circuit, thereby correcting the sensor output.
