The present invention relates to a vibration-type angular velocity sensor, and particularly to a vibration-type angular velocity sensor including a primary side control circuit that induces primary vibration in a vibrator, and a secondary side control circuit that detects and outputs secondary vibration generated in the vibrator due to an angular velocity applied to the vibrator.
In the related art, a vibration-type angular velocity sensor is known. The vibration-type angular velocity sensor is disclosed in, for example, Japanese Unexamined Patent Publication No. 2009-115559 and Japanese Patent No. 6463335.
In Japanese Unexamined Patent Publication No. 2009-115559, an element portion having a ring shape and a plurality of electrodes are arranged in a circumferential shape on the radial outer side of the element portion having a ring shape. The plurality of electrodes include a primary electrode and a secondary electrode. An AC power supply that generates primary vibration in the element portion having a ring shape is connected to one of the primary electrode and the secondary electrode by applying an AC voltage to one of the primary electrode and the secondary electrode. Further, detection means for detecting the magnitude of an electric signal generated in the other of the primary electrode and the secondary electrode is connected to the other of the primary electrode and the secondary electrode. Then, when rotational motion is generated in the normal direction of the element portion in a state in which the primary vibration is generated in the element portion having a ring shape, secondary vibration according to the angular velocity of the rotational motion is generated in the element portion. Then, the magnitude 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 means connected to the other of the primary electrode and the secondary electrode. Further, the AC voltage for cancelling the secondary vibration is applied to one of the primary electrode and the secondary electrode based on the magnitude of the detected electric signal. Then, the magnitude of the angular velocity is operated based on the magnitude of the AC voltage for cancelling the secondary vibration.
Further, in the vibration-type angular velocity sensor according to the related art as disclosed in Japanese Unexamined Patent 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 output from a sensor even in a state in which the angular velocity is not added). The bias component is generated due to the asymmetry of a gyro element included in the vibration-type angular velocity sensor. Therefore, the vibration-type angular velocity sensor according to the related art such as Japanese Unexamined Patent Publication No. 2009-115559 is configured to switch between an electrode to which the AC power supply is connected (one of the primary electrode and the secondary electrode) and an electrode to which the detection means is connected (the other of the primary electrode and the secondary electrode). Then, the bias component is cancelled by differentiating the outputs of the vibration-type angular velocity sensor before and after switching.
Here, in the vibration-type angular velocity sensor as disclosed in Japanese Unexamined Patent Publication No. 2009-115559, which cancels the bias component by switching between the electrode to which the AC power supply is connected and the electrode to which the detection means is connected, there is a case where a bias component which remains without being cancelled is generated. In this case, the remaining bias component fluctuates depending on temperature of a surrounding environment.
Japanese Patent No. 6463335 discloses a vibration-type angular velocity sensor including a primary side control circuit that induces primary vibration in a vibrator, and a secondary side control circuit that detects and outputs secondary vibration generated in the vibrator due to an 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 configured by a closed control loop. 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 independent of temperature are added to the closed control loop of the secondary side control circuit. As a result, an error caused by crosstalk from the primary side control circuit to the secondary side control circuit (an error inversely proportional to a first power and the square of the gain of the vibrator) is reduced. Note that, the first and second offset values are adjusted so as to reduce the error caused by the crosstalk from the primary side control circuit to the secondary side control circuit. As a result, the sensor output from the secondary side control circuit is corrected. As a result, it is possible to reduce the temperature fluctuation of an output from the vibration-type angular velocity sensor (an output value changes depending on temperature of the surrounding environments).
Then, by applying, before and after each of the switching, a configuration of Japanese Patent No. 6463335 to the vibration-type angular velocity sensor as disclosed in Japanese Unexamined Patent Publication No. 2009-115559, which cancels the bias component by switching between the electrode to which the AC power supply is connected and the electrode to which the detection means is connected, it is possible to reduce the temperature fluctuation of the remaining bias component.
However, as disclosed in Japanese Unexamined Patent Publication No. 2009-115559, in order to cancel the bias component by switching between the electrode to which the AC power supply is connected and the electrode to which the detection means is connected, the symmetry of the control of the vibration-type angular velocity sensor before and after the switching is important. Here, when the first and second offset values are set individually before and after the switching by applying the configuration of Japanese Patent No. 6463335 before and after the switching, generally, the first and second offset values are not symmetric before and after the switching. Therefore, when the first and second offset values that are not symmetric before and after switching are set, the symmetry of the control of the vibration-type angular velocity sensor is broken, so that there is a problem in that the temperature fluctuation component of a bias that remains without being cancelled becomes large.
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 which can suppress an increase in the temperature fluctuation component of the bias that remains without being cancelled.
In order to achieve the above object, according to a first aspect of the present invention, there is provided a vibration-type angular velocity sensor including a vibrator; a primary side control circuit that has a closed control loop, an output of the closed control loop inducing primary vibration in the vibrator; and a secondary side control circuit that has a closed control loop which detects secondary vibration generated in the vibrator due to an angular velocity applied to the vibrator, and is configured to correct a sensor output by adding an offset value to the closed control loop, in which the primary side control circuit and the secondary side control circuit are configured so that a function as the primary side control circuit and a function as the secondary side control circuit are interchangeable, and the offset value after interchange and the offset value before interchange are symmetric values with respect to a predetermined reference value.
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 are interchangeable, and the offset value after interchange and the offset value before interchange are symmetric values with respect to the predetermined reference value. As a result, the offset values become symmetrical with respect to the predetermined reference value before and after the function as the primary side control circuit and the function as the secondary side control circuit are interchanged, so that it is possible to suppress symmetry of the control of the vibration-type angular velocity sensor before and after interchange from being broken. As a result, it is possible to suppress an increase in the temperature fluctuation component of a bias that remains without being cancelled.
In the vibration-type angular velocity sensor according to the first aspect, preferably, the primary side control circuit and the secondary side control circuit respectively include the primary side loop filter and the secondary side loop filter in the closed control loop, and are configured to correct the sensor output by adding the offset values to the input of the secondary side loop filter. Here, an output in the closed control loop corresponds to an output of the loop filter. Then, the output of the loop filter is inversely proportional to a gain of the vibrator dependent on temperature due to a feedback operation of the closed control loop. The present invention focuses on this point, and, by adding the offset value to the input of the secondary side loop filter, it is possible to reduce an error due to crosstalk inversely proportional to a first power and/or square of the gain of the vibrator.
In the vibration-type angular velocity sensor according to the first aspect, preferably, when the offset value before interchange is set to a, the offset value after interchange is −a in which a polarity of the offset value before interchange is reversed. With this configuration, the offset values become 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 interchanged, so that it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor before and after interchange from being broken.
In the vibration-type angular velocity sensor according to the first aspect, preferably, when a temporary offset value before interchange is set to a, a temporary offset value after interchange is set to −a, and a temporary offset value with respect to a median value of the sensor output before interchange and the sensor output after interchange is set to b, the offset value before interchange is a+b and the offset value after interchange is −a+b. With this configuration, the offset values become symmetrical with respect to b before and after the function as the primary side control circuit and the function as the secondary side control circuit are interchanged, so that it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor before and after interchange from being broken. Further, since the offset values before and after interchange are symmetrical with respect to the offset value b with respect to the median value of the sensor outputs before and after interchange, it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor before and after interchange from being broken while reducing a gradient of the residue of the bias component with respect to environmental temperature. Note that, “temporary” means an offset value in an intermediate stage until a final offset value is obtained.
In the vibration-type angular velocity sensor according to the first aspect, preferably, a configuration is made so that, when the sensor output is corrected in an analog manner, the sensor output is corrected by adding a first offset value based on the output of the primary side control circuit inversely proportional to a temperature change of a gain of the vibrator in order to correct the sensor output inversely proportional to a 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 independent of temperature in order to correct the sensor output inversely proportional to the temperature change of the gain of the vibrator from the secondary side control circuit in the closed control loop of the secondary side control circuit, and by adjusting an addition amount of the first offset value and an addition amount of the second offset value. Here, when the second offset value based on the constant signal independent of temperature is added in the closed control loop of the secondary side control circuit, the output of the secondary side control circuit has a characteristic inversely proportional to the gain of the vibrator dependent on temperature. Further, similarly, the output of the primary side control circuit also has a characteristic inversely proportional to the gain of the vibrator due to the feedback operation of the closed control loop. Therefore, by adding the first offset value based on the output of the primary side control circuit 2 having the characteristic inversely proportional to the gain of the vibrator in the closed control loop of the secondary side control circuit, the output of the secondary side control circuit has the characteristic inversely proportional to the square of the gain of the vibrator. That is, the sensor output is corrected by adding the first offset value corresponding to the square of the gain of the vibrator and the second offset value corresponding to the first power of the gain of the vibrator and adjusting the addition amount of the first offset value and the addition amount of the second offset value, so that it is possible to perform correction inversely proportional to the first power of the gain of the vibrator and correction inversely proportional to the square of the gain of the vibrator.
In this case, preferably, a configuration is made so that, when the gain of the vibrator dependent on temperature is GR(T) and A, B, and C are constant values independent of temperature, a total VOut_Total_Error of an error of the sensor output generated in the closed control loop of the secondary side control circuit due to an error signal generated from a circuit block constituting the secondary side control circuit and an error of the sensor output generated in the closed control loop of the secondary side control circuit due to crosstalk from the primary side control circuit to the secondary side control circuit is expressed in the following Equation, and the sensor output is corrected in the analog manner by adjusting the addition amount of the first offset value based on the output of the primary side control circuit dependent on temperature inversely proportional to the temperature change of the gain of the vibrator so as to reduce A/GR2(T) which is a first term of the following Equation and adjusting the addition amount of the second offset value based on the constant signal independent of temperature so as to reduce B/GR(T) which is a second term of the following Equation. With this configuration, it is possible to reduce both a primary (a first power of the gain of the vibrator) component and a secondary (square of the gain of the vibrator) component of the error of the sensor output, so that it is possible to surely increase the accuracy of correction. Note that, although the constant value C remains, C is the constant value independent of temperature. Therefore, the error of the sensor output due to the temperature change is not influenced, so that there is no problem in correction.
In the vibration-type angular velocity sensor according to the first aspect, preferably, a configuration is made so that, when the sensor output is corrected in a digital manner, the sensor output is corrected by quantizing the output of the primary side control circuit dependent on temperature inversely proportional to a temperature change of a gain of the vibrator and by adding the offset value, which reduces an error of the sensor output due to the temperature change with respect to the quantized output of the primary side control circuit, to the secondary side control circuit. With this configuration, it is possible to correct the sensor output by only adding the offset value for reducing the error of the sensor output due to the temperature change to the secondary side control circuit, so that it is possible to simplify the configuration of the vibration-type angular velocity sensor unlike a case of adding an offset value other than the offset value based on the output of the primary side control circuit dependent on temperature.
In the vibration-type angular velocity sensor according to the first aspect, preferably, the vibrator includes a ring-type vibrator. Here, since the ring-type vibrator has a symmetrical shape, a vibration mode by the primary side control circuit and a vibration mode by the secondary side control circuit are similar. Therefore, when the present invention is applied to a vibration-type angular velocity sensor including the ring-type vibrator, it is not necessary to consider the influence of the difference in the vibration modes, so that it is possible to easily correct the sensor output.
According to a second aspect of the present invention, there is provided a vibration-type angular velocity sensor including a vibrator; a primary side control circuit that has a closed control loop, an output of the closed control loop inducing primary vibration in the vibrator; and a secondary side control circuit that has a closed control loop which detects secondary vibration generated in the vibrator due to an angular velocity applied to the vibrator, and is configured to correct a sensor output by adding an offset value to the closed control loop, in which a configuration is made so that a function of inducing the primary vibration and a function of detecting the secondary vibration are interchangeable, and the offset value after interchange and the offset value before interchange are symmetric values with respect to a predetermined reference value.
As described above, the vibration-type angular velocity sensor according to the second aspect of the present invention is configured so that the function of inducing the primary vibration and the function of detecting the secondary vibration are interchangeable, and the offset value after interchange and the offset value before interchange are symmetric values with respect to the predetermined reference value. As a result, the offset values are symmetrical with respect to the predetermined reference value before and after the function of inducing the primary vibration and the function of detecting the secondary vibration are interchanged, so that it is possible to suppress the symmetry of control of the vibration-type angular velocity sensor before and after interchange from being broken. As a result, it is possible to suppress an increase in the temperature fluctuation component of a bias that remains without being cancelled.
In the vibration-type angular velocity sensor according to 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 the closed control loop, and are configured to correct the sensor output by adding the offset values to an input of the secondary side loop filter. Here, an output in the closed control loop corresponds to an output of the loop filter. Then, the output of the loop filter is inversely proportional to a gain of the vibrator dependent on temperature due to a feedback operation of the closed control loop. The present invention focuses on this point, and, by adding the offset value to the input of the secondary side loop filter, it is possible to reduce an error due to crosstalk inversely proportional to a first power and/or square of the gain of the vibrator.
In the vibration-type angular velocity sensor according to the second aspect, preferably, when the offset value before interchange is set to a, the offset value after interchange is −a in which a polarity of the offset value before interchange is reversed. With this configuration, the offset values become 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 interchanged, so that it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor before and after interchange from being broken.
In the vibration-type angular velocity sensor according to the second aspect, preferably, when a temporary offset value before interchange is set to a, a temporary offset value after interchange is set to −a, and a temporary offset value with respect to a median value between the sensor output before interchange and the sensor output after interchange is set to b, the offset value before interchange is a+b, and the offset value after interchange is −a+b. With this configuration, the offset values become symmetrical with respect to b before and after the function as the primary side control circuit and the function as the secondary side control circuit are interchanged, so that it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor before and after interchange from being broken. Further, since the offset values before and after interchange are symmetrical with respect to the offset value b with respect to the median value of the sensor outputs before and after interchange, it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor before and after interchange from being broken while reducing a gradient of the residue of the bias component with respect to environmental temperature. Note that, “temporary” means an offset value in an intermediate stage until a final offset value is obtained.
In the vibration-type angular velocity sensor according to the second aspect, preferably, a configuration is made so that, when the sensor output is corrected in an analog manner, the sensor output is corrected by adding a first offset value based on the output of the primary side control circuit inversely proportional to a temperature change of a gain of the vibrator in order to correct the sensor output inversely proportional to a 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 independent of temperature in order to correct the sensor output inversely proportional to the temperature change of the gain of the vibrator from the secondary side control circuit in the closed control loop of the secondary side control circuit, and by adjusting an addition amount of the first offset value and an addition amount of the second offset value. Here, when the second offset value based on the constant signal independent of temperature is added in the closed control loop of the secondary side control circuit, the output of the secondary side control circuit has a characteristic inversely proportional to the gain of the vibrator dependent on temperature. Further, similarly, the output of the primary side control circuit also has a characteristic inversely proportional to the gain of the vibrator due to the feedback operation of the closed control loop. Therefore, by adding the first offset value based on the output of the primary side control circuit 2 having the characteristic inversely proportional to the gain of the vibrator in the closed control loop of the secondary side control circuit, the output of the secondary side control circuit has the characteristic inversely proportional to the square of the gain of the vibrator. That is, the sensor output is corrected by adding the first offset value corresponding to the square of the gain of the vibrator and the second offset value corresponding to the first power of the gain of the vibrator and adjusting the addition amount of the first offset value and the addition amount of the second offset value, so that it is possible to perform correction inversely proportional to the first power of the gain of the vibrator and correction inversely proportional to the square of the gain of the vibrator.
In this case, preferably, a configuration is made so that, when the gain of the vibrator dependent on temperature is GR(T) and A, B, and C are constant values independent of temperature, a total VOut_Total_Error of an error of the sensor output generated in the closed control loop of the secondary side control circuit due to an error signal generated from a circuit block constituting the secondary side control circuit and an error of the sensor output generated in the closed control loop of the secondary side control circuit due to crosstalk from the primary side control circuit to the secondary side control circuit is expressed in the following Equation, and the sensor output is corrected in the analog manner by adjusting the addition amount of the first offset value based on the output of the primary side control circuit dependent on temperature inversely proportional to the temperature change of the gain of the vibrator so as to reduce A/GR2(T) which is a first term of the following Equation and adjusting the addition amount of the second offset value based on the constant signal independent of temperature so as to reduce B/GR(T) which is a second term of the following Equation. With this configuration, it is possible to reduce both a primary (a first power of the gain of the vibrator) component and a secondary (square of the gain of the vibrator) component of the error of the sensor output, so that it is possible to surely increase the accuracy of correction. Note that, although the constant value C remains, C is the constant value independent of temperature. Therefore, the error of the sensor output due to the temperature change is not influenced, so that there is no problem in correction.
In the vibration-type angular velocity sensor according to the second aspect, preferably, a configuration is made so that, when the sensor output is corrected in a digital manner, the sensor output is corrected by quantizing the output of the primary side control circuit dependent on temperature inversely proportional to a temperature change of a gain of the vibrator and by adding the offset value, which reduces an error of the sensor output due to the temperature change with respect to the quantized output of the primary side control circuit, to the secondary side control circuit. With this configuration, it is possible to correct the sensor output by only adding the offset value for reducing the error of the sensor output due to the temperature change to the secondary side control circuit, so that it is possible to simplify the configuration of the vibration-type angular velocity sensor unlike a case of adding an offset value other than the offset value based on the output of the primary side control circuit dependent on temperature.
According to the present invention, as described above, it is possible to suppress an increase in the temperature fluctuation component of the bias that remains without being cancelled.
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
First, with reference to
As shown in
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 Phase Locked Loop (PLL) circuit (phase synchronous circuit) 26, and a reference signal generation circuit 27. Then, the vibrator 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 this order to constitute the closed control loop. Note that, the loop filter 23 consists of, for example, an integral filter. Further, the loop filter 23 is an example of a “primary side loop filter” in the claims.
The secondary side control circuit 3 includes an amplifier circuit 31, a synchronous detection circuit 32, an adder circuit 33, a loop filter 34, a modulation circuit 35, a drive circuit 36, and an amplifier circuit 37. Then, the vibrator 1, the amplifier circuit 31, the synchronous detection circuit 32, the adder circuit 33, the loop filter 34, the modulation circuit 35, and the drive circuit 36 are connected in this order to constitute a closed control loop. Note that, the adder circuit 33 is composed of a general addition-subtraction circuit using an operational amplifier. Further, the loop filter 34 consists of, for example, an integral filter. Further, the output of the loop filter 34 is input to the amplifier circuit 37. Then, a signal output from the amplifier circuit 37 is output to the outside as the sensor output of the vibration-type angular velocity sensor 100. Note that, the loop filter 34 is an example of a “secondary side loop filter” in the claims.
Here, in the first embodiment, the primary side control circuit 2 and the secondary side control circuit 3 are configured so that a function as the primary side control circuit 2 and a function as the secondary side control circuit 3 are interchangeable. Specifically, in the primary side control circuit 2, a switch 41 is provided on the input side of a signal to the vibrator 1 and a switch 42 is provided on the output side of the signal to the vibrator 1 (the output side of the amplifier circuit 21). Further, in the secondary side control circuit 3, a switch 43 is provided on the input side of the signal to the vibrator 1 and a switch 44 is provided on the output side of the signal 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 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, respectively. In
Further, the vibration-type angular velocity sensor 100 is provided with addition-subtraction amount adjusting circuits 4a and 4b to which an output from the primary side control circuit 2 (an output from the loop filter 23) is input. The addition-subtraction amount adjusting 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 dependent on temperature so that the adjusted output (first temporary offset value) is input to the adder circuit 33 of the secondary side control circuit 3. For example, in the addition-subtraction amount adjusting circuits 4a and 4b, the addition amount of the first temporary offset value is adjusted by dividing a voltage using a potentiometer (volume resistance) or the like.
Further, the vibration-type angular velocity sensor 100 is provided with an addition-subtraction amount adjusting circuit 5a to which a constant signal S1 independent of temperature is input. The addition-subtraction amount adjusting circuit 5a is configured to adjust the magnitude of the constant signal S1 so that the adjusted constant signal S1 (second temporary offset value) is input to the adder circuit 33 of the secondary side control circuit 3. For example, in the addition-subtraction amount adjusting circuit 5a, the addition amount of constant signal S1 is adjusted by dividing a voltage using a potentiometer (volume resistance) or the like.
Further, the vibration-type angular velocity sensor 100 is provided with an addition-subtraction amount adjusting circuit 5b to which a constant signal S2 independent of temperature is input. The addition-subtraction amount adjusting circuit 5b is configured to adjust the magnitude of the constant signal S2 so that the adjusted constant signal S2 (second temporary offset value) is input to the adder circuit 33 of the secondary side control circuit 3. For example, in the addition-subtraction amount adjusting circuit 5b, the addition amount of the constant signal S2 is adjusted by dividing a voltage using a potentiometer (volume resistance) or the like.
Here, in the first embodiment, when the sensor output is corrected in the analog manner, a first offset value based on the output of the primary side control circuit 2 (the output of the loop filter 23) inversely proportional to the temperature change of the gain of the vibrator 1 in order to correct the sensor output inversely proportional to the square of the temperature change of the gain of the vibrator 1 from the secondary side control circuit 3 is added to a second offset value based on the constant signal independent of temperature in order to correct the sensor output inversely proportional to the temperature change of the gain of the vibrator 1 from the secondary side control circuit 3, in the closed control loop of the secondary side control circuit 3 (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-subtraction amount adjusting circuits 4a and 4b and the addition-subtraction amount adjusting circuits 5a and 5b, respectively, so that the sensor output (output from the secondary side control circuit 3) is corrected. Then, the first offset value and the second offset value are determined and added so as to reduce the error of the sensor output, which is generated in the closed control loop of the secondary side control circuit 3 due to an error signal generated from a circuit block constituting the secondary side control circuit 3 and the error of the sensor output, which is 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, so that the sensor output is corrected.
Then, in the first embodiment, an offset value after interchange (the first offset value and the second offset value) and the offset value before interchange are symmetric values with respect to a predetermined reference value. In other words, a configuration is made so that the absolute value of the difference between the offset value added to the closed control loop before interchange and the predetermined reference value is approximately equal to the absolute value of the difference between the offset value added to the closed control loop after interchange and the predetermined reference value.
Specifically, in the first embodiment, when a temporary offset value before interchange is set to a, a temporary offset value after interchange is set to −a, and a temporary offset value with respect to a median value of the sensor output before interchange and the sensor output after interchange is set to b, the offset value before interchange is a+b and the offset value after interchange is −a+b. Note that, the temporary offset value a indicates a first temporary offset value a1 which will be described later and a second temporary offset value a2 which will be described later. Further, the temporary offset value b indicates a first temporary offset value b1 described later and a second temporary offset value b2 which will be described later. Note that, the temporary offset value b with respect to the median value is an example of a “predetermined reference value” in the claims.
Specifically, as shown in
Further, a NOT circuit 45 and a switch 46 are provided on the output side of the addition-subtraction amount adjusting circuit 5b. The switch 46 is configured to be able to switch between a state of being connected to the addition-subtraction amount adjusting circuit 5b and a state of being connected to the NOT circuit 45. Then, as shown in
(Configuration without Interchange of Function)
Next, with reference to
First, an error of the output of the vibration-type angular velocity sensor 100 to be corrected will be described. As the error of the output of the vibration-type angular velocity sensor 100, the error of the sensor output of the vibration-type angular velocity sensor 100, which is generated due to the error signal generated from the circuit block constituting the secondary side control circuit 3, and the error of the sensor output of the vibration-type angular velocity sensor 100, which is generated due to the influence (crosstalk) from the primary side control circuit 2, exist. It is assumed that the component (error component) of the error signal, which is generated from the circuit block constituting the secondary side control circuit 3, is a constant value having no temperature dependence. Note that, in general, in a feedback circuit, an output signal from each circuit is expressed using a value obtained by dividing an input signal input to each circuit by a feedback gain (output signal=input signal×1/(feedback gain)).
As described in Japanese Patent No. 6463335, the total VOut_Total_Error of the error of the sensor output, which is 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 of the sensor output, which is 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 expressed by the following Equation 5. Note that, A, B, and C are constant values (coefficients) independent of temperature.
Next, a case where the sensor output is corrected in the analog manner with respect to the error VOut_Total_Error of the sensor output of the vibration-type angular velocity sensor 100 expressed by the Equation 5 will be specifically described.
First, Vin_Const_Corr (second offset value) based on the constant signal independent of temperature is added to the input (path 2) of the loop filter 34 of the secondary side control circuit 3. In this case, the sensor output VOut_Const_Corr of the vibration-type angular velocity sensor 100 is expressed by the following Equation 6.
Here, when the second offset value based on the constant signal independent of temperature is added to the input of the loop filter 34, the sensor output VOut_Const_Corr becomes a value inversely proportional to the gain GR(T) dependent on temperature, as shown in the above Equation 6. Note that, p in the Equation 6 is a constant value. Then, by adjusting Vin_Const_Corr (second offset value) by the addition-subtraction amount adjusting circuit 5a so that the magnitude of p in the Equation 6 and the magnitude of B of B/GR(T) which is the second term in the Equation 5 are equal (p=−B), B/GR(T), which is the second term of the Equation 5, is cancelled. That is, by adjusting the second offset value based on the constant signal independent of temperature and adding the second offset value to the input of the loop filter 34, it is possible to cancel the term inversely proportional to the square of the gain GR(T) dependent on temperature in the above Equation 5.
Further, the output VAGC of the loop filter 23 of the primary side control circuit 2 dependent on temperature is expressed by the following Equation 7. Note that, the output VAGC of the loop filter 23 is the output of the loop filter 23 in consideration of the closed control loop, and is a value dependent on temperature.
Here, in the analog correction according to the first embodiment, in addition to Vin_Const_Corr (second offset value) based on the constant signal independent of temperature, a value (first offset value) obtained by multiplying the output VAGC by a certain ratio q is added to the input (path 2) of the loop filter 34 of the secondary side control circuit 3. The sensor output Vout_AGC_Corr of the vibration-type angular velocity sensor 100 when the first offset value is added is expressed by the following Equation 8.
Here, when the first offset value based on the output of the primary side control circuit 2 dependent on temperature is added to the input of the loop filter 34, the sensor output VOut_AGC_Corr is a value inversely proportional to the square of gain GR(T) dependent on temperature as shown in the Equation 8. Note that, r in the Equation 8 is a constant value. Then, by adjusting q by the addition-subtraction amount adjusting circuit 4b so that the magnitude of r in the Equation 8 and the magnitude of A of A/GR2(T) of the first term, which includes the square of GR(T) in the Equation 5 are equal (r=−A), A/GR2(T), which is the first term of the Equation 5, is cancelled. That is, while the sensor output of the vibration-type angular velocity sensor 100 becomes a value obtained by adding the error expressed by the Equation 5 to the original sensor output when the sensor output is not corrected, the first offset value and the second offset value are added in the first embodiment, so that the sensor output of the vibration-type angular velocity sensor 100 becomes a value obtained by adding a constant value C to the original sensor output.
Note that, since C in Equation 5 is a constant value independent of temperature, there is no problem in correction. Further, coefficients A, B, and C in the Equation 5 are calculated by measuring (actually measuring) the sensor output of the vibration-type angular velocity sensor 100 before correction (before compensation) at each temperature and by performing polynomial approximation on the measured data by the least squares method. Note that, the coefficients A, B, and C are calculated for each vibration-type angular velocity sensor 100 (for each product).
In this way, the sensor output is corrected in the analog manner by adjusting the addition amount of the first offset value based on the output of the primary side control circuit 2 dependent on temperature so that A/GR2(T) (a term inversely proportional to the square of the gain GR(T) dependent on temperature), which is the first term of Equation 5, is set to 0 and by adjusting the addition amount of the second offset value based on the constant signal independent of temperature so that B/GR(T) (a term inversely proportional to the gain GR(T) dependent on temperature), which is the second term of the Equation 5, is set to 0.
That is, as shown in
(Configuration with Interchange of Function)
Next, the offset value of the first embodiment, which is configured so that the function as the primary side control circuit 2 and the function as the secondary side control circuit 3 are interchangeable, will be described.
As shown in
Therefore, as shown in
Therefore, as shown in
In the first embodiment, the following effects can be obtained. Note that, in the following, a Q value (dimensionless number indicating the state of vibration) is described as having a characteristic that is approximately inversely proportional to temperature.
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 are interchangeable, and the offset value after interchange and the offset value before interchange are symmetric values with respect to the predetermined reference value. As a result, the offset values become symmetrical with respect to the predetermined reference value before and after the function as the primary side control circuit 2 and the function as the secondary side control circuit 3 are interchanged, so that it is possible to suppress the control symmetry of the vibration-type angular velocity sensor 100 before and after interchange from being broken. As a result, it is possible to suppress an increase in the temperature fluctuation component of a bias that remains without being cancelled.
Further, in the first embodiment, as described above, the primary side control circuit 2 and the secondary side control circuit 3 respectively include the loop filter 23 and the loop filter 34 in the closed control loop, and are configured to correct the sensor output by adding the offset values to the input of the loop filter 34. Here, the output in the closed control loop corresponds to the output of the loop filter. Then, the output of the loop filter is inversely proportional to the gain of the vibrator 1 dependent on temperature due to the feedback operation of the closed control loop. The first embodiment focuses on this point, and, by adding the offset value to the input of the loop filter 34, it is possible to reduce the error caused by the crosstalk inversely proportional to the first power and/or the square of the gain of the vibrator 1.
Further, in the first embodiment, as described above, when the offset value before interchange is set to a, the offset value after interchange is −a in which the polarity of the offset value before interchange is reversed. As a result, the offset values become 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 interchange, so that it is possible to suppress the control symmetry of the vibration-type angular velocity sensor 100 before and after interchange from being broken.
Further, in the first embodiment, as described above, when the temporary offset value before interchange is set to a, the temporary offset value after interchange is set to −a, and the temporary offset value with respect to the median value of the sensor output before interchange and the sensor output after interchange is set to b, the offset value before interchange is a+b and the offset value after interchange is −a+b. As a result, the offset values become symmetrical with respect to b before and after the function as the primary side control circuit 2 and the function as the secondary side control circuit 3 are interchanged, so that is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor 100 before and after interchange from being broken. Further, since the offset values before and after interchange are symmetrical with respect to the offset value b with respect to the median value of the sensor outputs before and after interchange, it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor 100 before and after interchange from being broken while reducing the gradient of the residue of the bias component with respect to environmental temperature.
Further, in the first embodiment, as described above, a configuration is made so that, when the sensor output is corrected in the analog manner, the sensor output is corrected by adding 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 vibrator 1 in order to correct the sensor output inversely proportional to the square of the temperature change of the gain of the vibrator 1 from the secondary side control circuit 3 and the second offset value based on the constant signal independent of temperature in order to correct the sensor output inversely proportional to the temperature change of the gain of the vibrator 1 from the secondary side control circuit 3 in the closed control loop of the secondary side control circuit 3, and adjusting the addition amount of the first offset value and the addition amount of the second offset value. Here, when the second offset value based on the constant signal independent of temperature is added in 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 vibrator 1 dependent on temperature. Further, similarly, the output of the primary side control circuit 2 also has a characteristic inversely proportional to the gain of the vibrator 1 due to the feedback operation of the closed control loop. Therefore, by adding the first offset value based on the output of the primary side control circuit 2 having the characteristic inversely proportional to the gain of the vibrator 1 in the closed control loop of the secondary side control circuit 3, the output of the secondary side control circuit 3 has the characteristic inversely proportional to the square of the gain of the vibrator 1. That is, the sensor output is corrected 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 addition amount of the first offset value and the addition amount of the second offset value, so that it is possible to perform correction inversely proportional to the first power of the gain of the vibrator 1 and correction inversely proportional to the square of the gain of the vibrator 1.
Further, in the first embodiment, as described above, a configuration is made so that, when the gain dependent on temperature of the vibrator 1 is GR(T) and A, B, and C are constant values independent of temperature, the total VOut_Total_Error of the error of 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 of 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 expressed in the Equation 5, and the sensor output is corrected in the analog manner by adjusting the addition amount of the first offset value based on the output of the primary side control circuit 2 dependent on temperature inversely proportional to the temperature change of the gain of the vibrator 1 so as to reduce A/GR2(T) which is the first term of the Equation 5 and adjusting the addition amount of the second offset value based on the constant signal independent of the temperature so as to reduce B/GR(T) which is the second term of the Equation 5. Therefore, it is possible to reduce both the primary (first power of the gain of the vibrator 1) component and the secondary (square of the gain of the vibrator 1) component of the error of the sensor output, so that it is possible to surely increase the accuracy of correction. Note that, although the constant value C remains, C is the constant value independent of temperature. Therefore, the error of the sensor output due to the temperature change is not influenced, so that there is no problem in correction.
Further, in the first embodiment, as described above, the vibrator 1 includes the ring-type vibrator 1. Here, since the ring-type vibrator 1 has a symmetrical shape, a vibration mode by the primary side control circuit 2 and a vibration mode by the secondary side control circuit 3 are similar. Therefore, when the present invention is applied to the vibration-type angular velocity sensor 100 including the ring-type vibrator 1, it is not necessary to consider the influence of the difference in the vibration modes, so that it is possible to easily correct the sensor output.
Further, in the first embodiment, as described above, the vibration-type angular velocity sensor 100 is configured so that the function of inducing the primary vibration and the function of detecting the secondary vibration are interchangeable, and the offset value after interchange and the offset value before interchange are symmetric values with respect to the predetermined reference value. As a result, the offset values are symmetrical with respect to the predetermined reference value before and after the function of inducing the primary vibration and the function of detecting the secondary vibration are interchanged, so that it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor 100 before and after interchange from being broken. As a result, it is possible to suppress an increase in the temperature fluctuation component of a bias that remains without being cancelled.
Next, with reference to
As shown in
Further, as in the first embodiment, 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 are interchangeable. Specifically, in the primary side control circuit 2, the switch 41 is provided on the input side of the signal to the vibrator 1 and the switch 42 is provided on the output side of the signal to the vibrator 1 (the output side of the amplifier circuit 21). Further, in the secondary side control circuit 3, the switch 43 is provided on the input side of the signal to the vibrator 1 and the switch 44 is provided on the output side of the signal to the vibrator 1 (the output side of the amplifier circuit 31).
Further, a configuration is made so that an analog signal dependent on temperature output from the loop filter 23 of the primary side control circuit 2 is input to the AD conversion circuit 6, and the AD conversion circuit 6 converts (quantizes) the analog signal into a digital signal and outputs the digital signal to the correction operation processing unit 7. Then, in the second embodiment, a configuration is made so that the correction operation processing unit 7 outputs an offset value for reducing an error of a sensor output due to a temperature change with respect to the quantized output of the primary side control circuit 2 (output from the AD conversion circuit 6) to the DA conversion circuit 8. Further, a configuration is made so that the DA conversion circuit 8 converts the offset value into the analog signal and adds the analog signal to the input of the loop filter 34 of the secondary side control circuit 3. As a result, a configuration is made so that the vibration-type angular velocity sensor 101 corrects the sensor output.
Next, a case where the sensor output is corrected in a digital manner will be specifically described with reference to
First, by measuring the sensor output of the vibration-type angular velocity sensor 101 while sweeping (changing to various values) the offset value (correction value) input to the adder circuit 33 of the secondary side control circuit 3, an offset value (y1, y2 . . . , see
Next, the following Equation 9 (1, m, and n are coefficients of constant values) is obtained (calculated) by setting a quantized output from the primary side control circuit 2 (loop filter 23) at each temperature to x, setting the offset value, at which the residue of the temperature fluctuation component of the bias (difference before and after interchange) is the minimized, to y, and performing polynomial approximation on data shown in
y=lx2+mx+n [Equation 9]
Similarly, the following Equation 10 is obtained by setting the quantized output from the primary side control circuit 2 (loop filter 23) at each temperature to x and using the offset value with respect to the median value of the bias components before and after interchange.
z=lx2+mx+n [Equation 10]
As a result, the relational expression (the Equation 9 and the Equation 10) between the offset value at each temperature and the quantized output of the primary side control circuit 2 at each temperature is obtained in advance (before the actual use of the vibration-type angular velocity sensor 101). Note that, the relational expression is calculated for each vibration-type angular velocity sensor 101 (for each product). Then, when the vibration-type angular velocity sensor 101 is actually used, in the vibration-type angular velocity sensor 101, the correction is performed by adding an offset value (y+z before interchange and −y+z after interchange), which is obtained by being operated by software in the correction operation processing unit 7 using the Equation 9 and the Equation 10 with respect to the quantized output (x) of the primary side control circuit 2, to the secondary side control circuit 3. That is, when the sensor output is corrected in a digital manner, an operation is always performed using the relational expressions (the Equation 9 and the Equation 10), and the correction is always performed to correspond to the quantized output of the primary side control circuit 2.
In the second embodiment, the following effects can be obtained.
In the second embodiment, as described above, a configuration is made so that, when the sensor output is corrected in a digital manner, the sensor output is corrected by quantizing the output of the primary side control circuit 2 dependent on temperature inversely proportional to the temperature change of the gain of the vibrator 1 and adding the offset value, which reduces the error of the sensor output due to the temperature change with respect to the quantized output of the primary side control circuit 2, to the secondary side control circuit 3. As a result, it is possible to correct the sensor output by only adding the offset value for reducing the error of the sensor output due to the temperature change to the secondary side control circuit 3, so that it is possible to simplify the configuration of the vibration-type angular velocity sensor 101 unlike a case of adding an offset value other than the offset value based on the output of the primary side control circuit 2 dependent on temperature.
Note that, it should be noted that the embodiments disclosed this time are exemplary in all aspects and are not restrictive. The scope of the present invention is shown by the claims rather than the description of the embodiment described above, and further includes all modifications within the meaning and scope equivalent to the claims.
For example, in the first and second embodiments, an example in which the ring-type vibrator is used is shown, but the present invention is not limited thereto. For example, the vibrator may have a symmetrical shape, and a vibrator having a disk type, a cup type (wine glass type), an octagonal type, or the like may be used.
Further, in the first and second embodiments, an example in which the closed control loop is configured by the vibrator, the amplifier circuit, the synchronous detection circuit, the loop filter, the modulation circuit, and the drive circuit is shown, but the present invention is not limited thereto. For example, the control loop may be configured by a configuration other than the configuration consisting of the amplifier circuit, the synchronous detection circuit, the loop filter, the modulation circuit, and the drive circuit.
Further, in the first and second embodiments, an example in which an integral filter is used as the loop filter is shown, but, for example, a loop filter other than the integral filter may be used.
Further, in the first embodiment, an example is shown in which the first offset value before interchange is a1+b1 and the second offset value is a2+b2, and the first offset value after interchange is −a1+b1 and the second offset value is −a2+b2. However, the present invention is not limited thereto. For example, the first offset value before interchange may be a1 and the second offset value may be a2, and the first offset value after interchange may be −a1 in which the polarity of the first offset value a1 before interchange is reversed and the second offset value after interchange may be −a2 in which the polarity of the second offset value a2 before interchange is reversed. As a result, before and after the function as the primary side control circuit 2 and the function as the secondary side control circuit 3 are interchanged, some residue of the temperature fluctuation component of the bias remains. However, 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 it is possible to suppress the symmetry of the control of the vibration-type angular velocity sensor before and after interchange from being broken.
Further, in the first embodiment, an example is shown in which the first offset value before interchange is a1+b1 and the second offset value is a2+b2, and the first offset value after interchange is −a1+b1 and the second offset value is −a2+b2. However, the present invention is not limited thereto. For example, a configuration may be made so that the median value is determined to cancel the first term of the Equation 5 (that is, the first offset value is fixed to b1), the second offset value before interchange is a2+b2, and the second offset value after interchange may be −a2+b2. That is, only the second offset value may be a symmetric value with respect to a predetermined reference value before and after interchange.
Further, in the first and second embodiments, an example is shown in which the first temporary offset value a1 and the second temporary offset value a2 before and after interchange are determined so that the residue of the bias component becomes the smallest before and after interchange. However, the present invention is not limited thereto. For example, the first offset value and the second offset value before and after interchange may be determined so that the residue of the bias component becomes a value in the vicinity of the smallest value before and after interchange.
Further, in the first embodiment, an example is shown in which the addition-subtraction amount adjusting circuits 4a and 4b and the addition-subtraction amount adjusting circuits 5a and 5b (four individual circuits) are provided so as to output the offset value a+b and the offset value −a+b. However, the present invention is not limited thereto. In the present invention, a circuit that outputs a signal corresponding to the offset value a+b and the offset value −a+b may be provided.
Number | Date | Country | Kind |
---|---|---|---|
2020-052440 | Mar 2020 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2021/011906 | 3/23/2021 | WO |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2021/193600 | 9/30/2021 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
10161751 | Moriguchi | Dec 2018 | B2 |
11982532 | Moriguchi | May 2024 | B1 |
20080264168 | Stewart | Oct 2008 | A1 |
20090173157 | Stewart | Jul 2009 | A1 |
20130104653 | Bernstein | May 2013 | A1 |
20160231118 | Trusov | Aug 2016 | A1 |
20160377433 | Moriguchi | Dec 2016 | A1 |
20230123765 | Moriguchi | Apr 2023 | A1 |
Number | Date | Country |
---|---|---|
108253952 | Jul 2018 | CN |
115315612 | Nov 2022 | CN |
2009115559 | May 2009 | JP |
6463335 | Jan 2019 | JP |
6761140 | Sep 2020 | JP |
2021152466 | Sep 2021 | JP |
WO-0179862 | Oct 2001 | WO |
WO-2005075939 | Aug 2005 | WO |
WO-2015129464 | Sep 2015 | WO |
WO-2023037559 | Mar 2023 | WO |
Entry |
---|
Kline et al. Quadrature FM Gyroscope, Proceedings of the IEEE International Conference on Micro Electro Mechanical Systems (MEMS), MEMS 2013, Taipei, Taiwan, Jan. 20-24, 2013, pp. 604-608 (Year: 2013). |
European Patent Office (EPO), European Search Report EP 21 77 4317, Jun. 10, 2024, p. 3 (Year: 2024). |
European Patent Office (EPO), European Written Opinion EP 21 77 4317 Form 1703, Jun. 10, 2024, p. 4 (Year: 2024). |
International Search Report (PCT/ISA/210) issued in PCT Application No. PCT/JP2021/011906 dated Jun. 15, 2021 with English translation (five (5) pages). |
Japanese-language Written Opinion (PCT/ISA/237) issued in PCT Application No. PCT/JP2021/011906 dated Jun. 15, 2021 (three (3) pages). |
Number | Date | Country | |
---|---|---|---|
20230123765 A1 | Apr 2023 | US |