The present invention relates to a circuit apparatus, a physical quantity measuring apparatus, an electronic device, a vehicle, and the like.
In electronic devices such as digital cameras and smartphones, and vehicles such as cars and airplanes, a physical quantity measuring apparatus for detecting physical quantities which change due to external factors is incorporated. For example, a gyro sensor that detects an angular velocity is used for so-called camera shake correction, attitude control, GPS autonomous navigation, and the like.
In order to properly perform processing such as camera shake correction, attitude control, and the like, it is important to detect an abnormality of the physical quantity measuring apparatus. In a case where an abnormality occurs in the physical quantity measuring apparatus, the physical quantity to be measured deviates from an original value (an original angular velocity if the physical quantity measuring apparatus is a gyro sensor), and appropriate processing may not be executed.
For example, JP-A-2010-107416 discloses a method for tuning a self-vibration component to shift from zero and determining a failure when the extracted self-vibration component decreases in the tuning of a vibrator (physical quantity transducer).
In addition, JP-A-2015-114220 discloses a method for reducing a DC offset (error of a zero point) in a gyro sensor by using the Kalman filter that extracts the DC component of an input signal. Detection errors of angles may be reduced, and processing such as camera shake correction may be performed with high accuracy by reducing the DC offset.
In a physical quantity measuring apparatus, a connection abnormality between a physical quantity transducer and a detection circuit may occur. For example, in a gyro sensor, a failure mode in which at least one of a sensor detection electrode and a pad of the detection circuit is disconnected is conceivable. In this failure mode, a sensor signal (detection signal) may not be detected at all, but causes only a phenomenon such as a sensitivity abnormality and zero point variation. For example, in a case where the angular velocity detected by the gyro sensor decreases, it is not easy to determine whether the rotation is actually small (slow) or whether the gyro sensor is in the failure mode.
In the method of JP-A-2010-107416, in order to detect the failure mode (connection abnormality), it is necessary to set and detect a self-vibration component (leakage vibration component), and in addition to a physical quantity detection circuit, a self-vibration component extraction circuit including a synchronous detection circuit, an amplifier, an integration circuit, and the like is provided. Therefore, even in a case where a detection element and the physical quantity detection circuit have no problem, but in a case where an abnormality occurs in this self-vibration component extraction circuit, there is a problem that it is determined as a failure. In addition, the method of JP-A-2015-114220 is intended to improve the detection accuracy of the gyro sensor and does not perform abnormality detection.
An advantage of some aspects of the invention is to solve at least a part of the problems described above, and the invention can be implemented as the following forms or embodiments.
An aspect of the invention relates to a circuit apparatus used in a physical quantity measuring apparatus, the apparatus including a detection circuit that performs physical quantity detection processing based on a detection signal from a physical quantity transducer and a processing circuit that performs processing based on an output signal of the detection circuit, in which the processing circuit obtains index information of floor noise generated in the detection circuit based on the output signal and performs abnormality detection of the physical quantity measuring apparatus based on the index information.
In the aspect of the invention, the processing circuit may detect abnormality of the physical quantity measuring apparatus based on index information of the floor noise generated in the detection circuit. With this configuration, it is possible to appropriately detect a connection abnormality which is an abnormality in a signal processing path from the physical quantity transducer to the detection circuit and is not easy to detect by signal level determination of the detection signal or the like.
In the aspect of the invention, the processing circuit may perform the abnormality detection of the connection between the physical quantity transducer and the detection circuit based on the index information.
With this configuration, it is possible to appropriately detect a connection abnormality between the physical quantity transducer and the detection circuit.
In the aspect of the invention, the processing circuit may include an abnormality detection unit that compares an index value that is the index information of the floor noise with a threshold value and performs the abnormality detection.
With this configuration, it is possible to detect an abnormality by threshold determination using the index value of the floor noise.
In the aspect of the invention, the detection circuit may include an amplifier circuit to which the detection signal is input and the floor noise includes floor noise generated in the amplifier circuit.
With this configuration, it is possible to perform abnormality detection or the like based on the index information of the floor noise generated in the amplifier circuit.
In the aspect of the invention, the amplifier circuit may be a Q/V conversion circuit or an I/V conversion circuit.
With this configuration, in the case of using the Q/V conversion circuit or the I/V conversion circuit as the amplifier circuit, it is possible to appropriately perform abnormality detection or the like.
In the aspect of the invention, the processing circuit may include a floor noise detection circuit that detects the index information of the floor noise, and the floor noise detection circuit includes an arithmetic circuit that obtains an effective value of the floor noise.
With this configuration, it is possible to obtain an effective value of the floor noise as the index information of the floor noise.
In the aspect of the invention, the floor noise detection circuit may include a high-pass filter that performs filter processing on the output signal of the detection circuit and the arithmetic circuit, in which the arithmetic circuit may include a square arithmetic processing unit that performs a square operation on the filtered signal or an absolute value arithmetic processing unit that performs absolute value operation on the filtered signal, and a smoothing circuit that smoothes the output of the square arithmetic processing unit or the absolute value arithmetic processing unit.
With this configuration, it is possible to realize the floor noise detection circuit with an appropriate configuration.
In the aspect of the invention, the processing circuit may include the Kalman filter for performing Kalman filter processing based on an observation noise and a system noise to extract a DC component of the output signal of the detection circuit, and the index information of the floor noise may be error covariance output from the Kalman filter.
With this configuration, it is possible to obtain the index value of the floor noise by using the Kalman filter that extracts the DC component of the output signal.
In the aspect of the invention, the processing circuit may include the Kalman filter for performing Kalman filter processing based on the observation noise and the system noise to extract a DC component of the output signal of the detection circuit and a noise estimation unit that obtains the index information based on the output signal of the detection circuit, in which the noise estimation unit may estimate the observation noise and the system noise based on the index information and outputs the observation noise and the system noise to the Kalman filter.
With this configuration, it is possible to obtain the index value of the floor noise by using a noise estimation unit for dynamically changing the observation noise and the system noise used in the Kalman filter.
Another aspect of the invention relates to a physical quantity measuring apparatus including the circuit apparatus as described above and the physical quantity transducer.
Another aspect of the invention relates to an electronic device including any of the circuit apparatuses described above.
Another aspect of the invention relates to a vehicle including any of the circuit apparatuses described above.
The invention will be described with reference to the accompanying drawings, wherein like numbers reference like elements.
Hereinafter, a preferred embodiment of the invention will be described in detail. The present embodiment described below does not unduly limit the contents of the invention described in the appended claims, and not all of the configurations described in the embodiment are necessarily indispensable as a solving means of the invention.
As described above, it is considered that an abnormality of the physical quantity measuring apparatus may be an abnormality in which the sensitivity or zero point of the detection signal TQ is in a state different from a normal state and does not reach a state in which the detection signal TQ may not be detected. In that case, even if the value (for example, amplitude level) of the input signal PI is simply monitored, it is difficult to detect an abnormality. This is because, when the input signal PI reaches a predetermined signal level, it may not be determined whether there is such input (for example, if there is rotation of the angular velocity corresponding to the signal level in the gyro sensor) or an abnormality.
Therefore, in the embodiment, the processing circuit 100 obtains index information of the floor noise generated in the detection circuit 60 based on the output signal of the detection circuit 60 and performs abnormality detection of the physical quantity measuring apparatus based on the index information.
Here, the floor noise represents noise generated in the detection circuit 60, such as thermal noise or a l/f noise. Specifically, as shown in
In the amplifier circuit 64, it is assumed that the noise in the entire circuit is generated at an input point (Nin in
As can be seen from
Here, if the physical quantity transducer 12 and the detection circuit 60 are normally connected, the value of the parasitic capacitance Cp seen from the detection circuit 60 does not change greatly and is considered to be sufficiently close to a predetermined value determined by the design. On the other hand, in a case where a connection abnormality occurs, such as disconnection of a connection signal line between the physical quantity transducer 12 and the detection circuit 60 (circuit apparatus 300), the value of the parasitic capacitance Cp decreases (in a narrow sense, the parasitic capacitance Cp due to the physical quantity transducer 12 becomes invisible from the detection circuit 60). In a case where the sensor detection electrode and the pad of the detection circuit are electrically connected by, for example, wire bonding, a connection abnormality is caused by narrowing at least one of a bonding area between the detection electrode and a wire and a bonding area between the pad and the wire (the wire peels off).
Originally, floor noise is generated at a certain level and is not supposed to be smaller than this level. However, when an abnormality occurs, the level of the floor noise decreases to such a level that the level of the floor noise may be distinguished compared to the level of the floor noise level in the normal state due to the decrease in the parasitic capacitance Cp. Therefore, the circuit apparatus 300 (processing circuit 100) of the embodiment obtains the index value of the floor noise and uses the index value to determine the level of the floor noise. In a case where the level of the floor noise is smaller compared to the normal state, the processing circuit 100 determines that an abnormality has occurred.
As described above, the processing circuit 100 of the embodiment performs abnormality detection of the connection between the physical quantity transducer 12 and the detection circuit 60 based on index information of the floor noise. It is possible to appropriately detect even a connection abnormality by using the index information of the floor noise, which is difficult to detect by a method simply using the signal level of the input signal PI.
As described above, the zero point and the sensitivity of the input signal PI of the detection circuit 60 change due to the occurrence of a connection abnormality, but the signal value itself may not become 0 in some cases. In
On the other hand, although the index information (effective value) of the floor noise maintains a value near a certain level before the timing of A1, the value clearly decreases due to the occurrence of a connection abnormality. Therefore, as shown in
In addition, the configuration of the amplifier circuit 64 of the embodiment is not limited to
In the processing circuit 100, there are several methods for obtaining index information of the floor noise of the detection circuit 60 (estimating floor noise). Hereinafter, first to third embodiments will be described.
As shown in
The high-pass filter 131 performs filter processing (high-pass filter processing) on the output signal (input signal PI) of the detection circuit 60 to remove the DC component from the output signal. The square arithmetic processing unit 133 squares the signal after removing the DC component. The smoothing circuit 134 smoothes the signal squared by the square arithmetic processing unit 133 and obtains the root mean square. The noise component of the signal is extracted by the root mean square. The smoothing circuit 134 may be realized by, for example, a low-pass filter. From the smoothing circuit 134, the effective value (variance of floor noise) of the floor noise is output.
However, the arithmetic circuit 132 may obtain an effective value of the floor noise. The effective value is not limited to the signal level of the signal whose input signal PI is subjected to square arithmetic processing but may be another value representing the magnitude of the signal value. The magnitude of the signal value is a positive value generated based on the signal and for example, is the absolute value of the signal value, the square of the signal value, the peak-to-peak value of the signal, the difference between the maximum value and the minimum value of the signal within a predetermined time, and the like. Alternatively, the magnitude of the signal value may be a value obtained by performing some calculation (for example, gain processing or the like) thereon.
For example, the arithmetic circuit 132 may include an absolute value arithmetic processing unit and a smoothing circuit 134 that smoothes the output of the absolute value arithmetic processing unit. In this case, information corresponding to the average of the absolute values of the floor noise is output from the smoothing circuit 134.
As described above, by using the floor noise detection circuit 130, index information (variance, absolute value average, and the like) representing the level of the floor noise is obtained. The processing circuit 100 includes an abnormality detection unit 170 that compares the index value that is index information of the floor noise with the threshold value and performs abnormality detection. Here, the threshold value is a value that may distinguish between the index value of the floor noise in the normal state and the index value of the floor noise in an abnormal state. In the example in which the index value increases as the noise level of the floor noise increases, the abnormality detection unit 170 determines that an abnormality has occurred in a case where the index value represented by the index information is smaller than the threshold value.
The Kalman filter 120 performs Kalman filter processing based on observation noise σmeas and system noise σsys and outputs a DC component DCQ of the input signal PI as an estimation value. In addition, the Kalman filter 120 outputs error covariance Vc2 of the estimation value to the abnormality detection unit 170.
By using the DC component DCQ of the input signal PI estimated by the Kalman filter 120, the DC offset (error of zero point) may be reduced. For example, the processing circuit 100 may perform processing of subtracting the estimated DC component DCQ from the input signal PI.
Here, the Kalman filtering processing is processing of estimating an optimum state of the system by using an observation value acquired from the past to the present, assuming that noise (error) is included in the observation values and a variable representing the state of the system. In the case of the embodiment, the observation value is the input signal PI, and a variable to be estimated is the DC component DCQ. In the Kalman filter processing, observation updating (observation process) and time updating (prediction process) are performed repeatedly to estimate the state. The observation updating is a process of updating a Kalman gain, an estimation value, error covariance by using the observation value and the result of the time updating. The time updating is a process of predicting the estimation value and error covariance at a next time by using the result of the observation updating.
As the observation noise σmeas and the system noise σsys, predetermined values estimated in advance are used, for example. In this case, the observation noise σmeas and the system noise σsys (or variance thereof σmeas2 and σsys2) are stored, for example, in a register or a memory, and the Kalman filter 120 reads the observation noise σmeas and the system noise σsys from the register or the memory. Alternatively, the processing circuit 100 may include a noise estimation unit 110 that dynamically changes the observation noise σmeas and the system noise σsys, as described in the third embodiment. In this case, the observation noise σmeas and the system noise σsys are supplied from the noise estimation unit 110 to the Kalman filter 120.
The DC component DCQ estimated (extracted) by the Kalman filter 120 is a component whose frequency is lower than a desired signal component to be extracted from the input signal PI. For example, in a gyro sensor, the input signal PI (physical quantity signal) includes an offset, and a change based on the offset is an actual signal component. The frequency of the signal component corresponds to the frequency of the motion detected by the gyro sensor. Since the offset varies with time due to a temperature change or the like, the offset is not a frequency of zero, but a frequency lower than the frequency of the motion.
The error covariance Vc2 is estimated by the Kalman filter 120 as to how much the estimation value (DC component DCQ) may be trusted. The error covariance Vc2 decreases as it is determined that an estimation value close to a true value is obtained. In other words, the case where the error covariance Vc2 becomes sufficiently small (converges to a predetermined value) represents a state in which the estimation accuracy of the DC component is sufficiently high. As the floor noise included in the input signal PI decreases, the estimation accuracy of the DC component also increases, and the error covariance Vc2 further decreases. In other words, since the error covariance Vc2 is information that becomes smaller as the floor noise decreases, the error covariance Vc2 may be used as index information of the floor noise.
The abnormality detection unit 170 performs abnormality detection based on the comparison of the value of the error covariance Vc2 from the Kalman filter 120 and a given threshold value. Since the error covariance Vc2 is not always the value of the floor noise itself, the threshold here may be set in consideration of this point.
In JP-A-2015-114220, it is determined whether or not the signal level of the input signal exceeds a predetermined range. In a case where it is determined that the signal level of the input signal exceeds the predetermined range, the time updating of the error covariance is stopped. The Kalman filter 120 of the embodiment may have the same configuration as that of JP-A-2015-114220.
However, according to the method of JP-A-2015-114220, the threshold setting for switching between validity and invalidity of the estimation operation of the Kalman filter is fixed. Therefore, in a case where there is an input smaller than a fixed threshold (for example, rotation of a minute angular velocity in the gyro sensor), the estimation operation of the Kalman filter does not stop and there is a possibility that the estimation value follows the input. Doing so may reduce the accuracy or stability of the estimation value with respect to the true value of the DC component.
Therefore, the processing circuit 100 of the embodiment may include the monitoring unit 180 as shown in
The monitoring unit 180 sets a threshold value Vth used for stop determination of the observation updating processing according to the error estimation value Vc. Specifically, as the error estimation value Vc decreases, the threshold value Vth decreases. For example, as will be described later with reference to
The noise estimation unit 110 estimates the observation noise σmeas and the system noise σsys dynamically changing according to the input signal PI (input data). Specifically, the noise estimation unit 110 generates the system noise from the input signal PI and changes the variance σmeas2 of the observation noise and the variance σsys2 of the system noise according to the signal value of the input signal PI or the change thereof. The noise estimation unit 110 outputs the estimated observation noise σmeas and the system noise σsys to the Kalman filter 120.
The Kalman filter 120 performs Kalman filter processing based on the variance σmeas2 of the observation noise estimated by the noise estimation unit 110 and the variance σsys2 of the system noise to extract the DC component DCQ of the input signal PI.
For a general Kalman filter, an initial value of the error covariance and the system noise are given in advance as known ones. The value of the error covariance is updated by the observation updating and the time updating. As described above, for a general Kalman filter, the observation noise and the system noise are not externally given newly during the repetition of the updating.
On the other hand, in the embodiment, the observation noise σmeas and the system noise σsys are dynamically changed and supplied from the outside to the Kalman filter 120. As will be described in the following Equations (2) to (6), the observation noise σmeas and the system noise σsys affect internal variables such as a Kalman gain g(k) and the like. That is, it means that a filter characteristic of the Kalman filter 120 may be adaptively controlled by controlling the observation noise σmeas and the system noise σsys. In the embodiment, by using this point, when the DC component of the input signal PI (the physical quantity signal of the gyro sensor) is not changing, a passing band may be set to a low frequency and the passing band of the signal component may be extended to the low-frequency side. In addition, when the DC component changes, the observation noise σmeas and the system noise σsys are changed to extend the passing band so as to conform to the change in the DC component. In this way, it is possible to improve the transient responsiveness to the change of the input signal PI and the conformity with the change of the DC component.
As will be described later with reference to
The details of Kalman filter processing will be described below. The Kalman filter 120 performs first linear Kalman filter processing shown in the following Equations (2) to (6).
Equations (2) and (3) are equations of the time updating (prediction process), and the above Equations (4) to (6) are equations of the observation updating (observation process). k represents a discrete time, and time updating and observation updating are performed once each time k progresses by one. x(k) is the estimation value of the Kalman filter 120. That is, DCQ=×(k). x−(k) is a predictive estimate predicted before obtaining the observed value. P(k) is the error covariance of the Kalman filter 120. That is, Vc2=P(k). P−(k) is the error covariance predicted before the observed value is obtained. y(k) is the observed value. That is, PI=y(k). σsys(k) is the system noise, and σmeas (k) is the observation noise.
The Kalman filter 120 stores an estimation value x(k−1) and error covariance P(k−1) updated at a previous time k−1. Then, the observation value y(k), the observation noise σmeas (k), and the system noise σsys(k) are accepted at the current time k, and the time updating and observation updating of the above Equations (2) to (6) are performed by using the accepted values and an estimation value x(k) is output as a DC component.
Stopping observation updating processing is stopping the updating of at least one of the estimation value and the error covariance. Stopping updating of the estimation value is to stop updating by the above Equation (5). For example, storing the calculation result on the right side of Equation (5) in the register corresponds to updating of the estimation value. By stopping the storing in this register, updating of the estimation value is stopped. Alternatively, updating of the estimation value may be stopped by stopping the calculation on the right side of the above Equation (5). Stopping the updating of the error covariance is to stop updating by the above Equation (6).
The methods of obtaining index information of the floor noise are not limited to those described in the first to third embodiments.
For example, in the third embodiment, an example in which Vn2 which is the output of the noise estimation unit 110 is used as index information (index value) of floor noise, but as in the second embodiment, the error covariance Vc2 output from the Kalman filter 120 may be used as index information of the floor noise. Alternatively, the abnormality detection unit 170 may perform abnormality detection by using both of Vn2 as first index information and the error covariance Vc2 as second index information. Alternatively, the abnormality detection unit 170 is configured to acquire two pieces of index information, and the selected one piece of information may be used for abnormality detection.
In addition, it is also possible to combine the first embodiment and the second embodiment. For example, the processing circuit 100 may include the floor noise detection circuit 130 shown in
The selector 122 selects either the DC component DCQ estimated by the Kalman filter 120 or data “0”. The subtraction processing unit 121 subtracts the output of the selector 122 from the input signal PI and outputs the result as a signal PQ. In a case where the selector 122 selects the DC component DCQ, PQ=PI−DCQ, and in a case where the selector 122 selects data “0”, PQ=PI. The selector 122 may be omitted and the DC component DCQ may be directly input to the subtraction processing unit 121. Alternatively, the selector 122 and the subtraction processing unit 121 may be omitted, and the input signal PI may be directly used as the signal PQ.
The monitoring unit 180 includes a gain processing unit 181, an offset addition processing unit 182, and a comparator 183. The gain processing unit 181 performs gain processing on the error covariance Vc2. The offset addition processing unit 182 adds an offset VOS to the output of the gain processing unit 181. The comparator 183 performs process of comparing the signal level of the signal PQ and the output of the offset addition processing unit 182 as the determination processing based on the error covariance Vc2.
Specifically, the gain processing unit 181 multiplies the error covariance Vc2 by a gain GA3. The output of the offset addition processing unit 182 corresponds to the square of the threshold value Vth (Vth2), and the following Equation (7) is obtained. The comparator 183 compares the square (PQ2) of the signal PQ with the square (Vth2) of the threshold Vth and outputs an active stop flag FLOV in a case where the square (PQ2) of the signal PQ is larger than the square (Vth2) of the threshold Vth, and outputs an inactive stop flag FLOV in a case where the square (PQ2) of the signal PQ is smaller than the square (Vth2) of the threshold Vth. Details of the gain GA3 and the offset VOS of the following Equation (7) will be described later.
Vth
2
=GA3×Vc2+VOS (7)
According to the embodiment, by performing gain processing on the error covariance Vc2 and adding the offset VOS to the result, it is possible to obtain the threshold value Vth that changes according to the error covariance Vc2. Then, by comparing the signal level of the signal PQ with the output of the offset addition processing unit 182, it is possible to determine whether or not the signal level has exceeded the threshold value Vth that changes according to the error covariance Vc2. In addition, since the square of the threshold value Vth is obtained by a linear function (gain processing, addition processing of offset) of the error covariance Vc2, the threshold value Vth may be adjusted by the linear function. Thus, it is possible to set an appropriate threshold value Vth for the system.
The first estimation unit 140 estimates the noise due to the motion of the gyro sensor (a large change in the input signal PI). Specifically, the first estimation unit 140 includes a high-pass filter 141, a square arithmetic processing unit 142, a peak-hold unit 143, a gain processing unit 144, and an addition processing unit 145.
The high-pass filter 141 removes the DC component from the signal PQ. Since the square mean is performed at a later stage, it is possible to prevent the DC component from being squared and becoming an error of the observation noise σmeas by eliminating the DC component. The square arithmetic processing unit 142 squares the signal from the high-pass filter 141. The peak-hold unit 143 receives the signal of an AC component passed through the high-pass filter 141 and the square arithmetic processing unit 142 and holds the peak of the signal. The gain processing unit 144 performs gain processing (processing of multiplying by a gain GA4) on the output of the peak-hold unit 143 and outputs the result as motion noise Vpp2 (variance of the motion noise). The addition processing unit 145 adds the motion noise Vpp2 and the floor noise Vn2 generated by the second estimation unit 150 and outputs the result as the variance σmeas2 of the observation noise.
As the motion detected by the gyro sensor is larger, the signal from the peak-hold unit 143 also becomes larger, so the observation noise σmeas increases as the motion increases. Increasing observation noise σmeas decreases the Kalman gain g(k) as seen from the above Equation (4), and as can be seen from the above Equation (5), the weight of the observation value y(k) is lowered and the estimation value x(k) can be calculated. As a result, as the AC component of the motion increases, the influence of the observed value y(k) decreases, and DC components with higher accuracy may be extracted.
The floor noise output from the motion noise Vpp2 is expressed by the following Equation (8). Vn is the floor noise of the input signal PI. GA4 is a gain of the gain processing unit and is a coefficient for adjusting the degree of influence of the peak-hold unit 143. Peak-hold processing of the squared signal of noise results in outputting a maximum value during a certain period of time, and an effective gain Gpeak is applied to the average value of the squared signal of the noise. The peak-hold unit 143 holds the peak of the input signal and then outputs a signal divided by Gpeak.
Vpp
2
=GA4×Vn2 (8)
The second estimation unit 150 estimates the floor noise of the input signal PI. Specifically, the second estimation unit 150 includes a square arithmetic processing unit 151, a selector 152, a low-pass filter 153, and a limiter 154.
The square arithmetic processing unit 151 squares the signal PQ. The selector 152 selects the output of the square arithmetic processing unit 151 or the output of the square arithmetic processing unit 142 of the first estimation unit 140. The low-pass filter 153 filters (smoothes) the signal squared by the square arithmetic processing unit 151 and obtains the root mean square thereof. The noise component of the signal is extracted by the root mean square. The limiter 154 performs limit processing on the signal from the low-pass filter 153. Specifically, in a case where the signal from the low-pass filter 153 is equal to or lower than a lower limit value, the output is limited to the lower limit value, and in a case where the signal from the low-pass filter 153 is larger than the lower limit value, the signal is output as it is. The lower limit value is smaller than an assumed minimum floor noise and is, for example, 1 digit. As a result, from the output of the limiter 154, the index value Vn2 of the floor noise (index value corresponding to the variance of the floor noise) is output.
The gain processing unit 115 multiplies the floor noise Vn2 from the second estimation unit 150 by a constant gain GA1 and outputs the result to the addition processing unit 167. The gain GA1 is set as shown in the following Equation (12). The derivation method of the following Equation (12) will be described below.
First, a relationship between the observation noise σmeas and the system noise σsys in a state where sufficient time has elapsed is obtained. The state in which sufficient time has elapsed may be set by assuming a situation where k=cc, and if prior error covariance P−(k) converges to a fixed value, the following Equation (9) holds. The convergence value of the prior error covariance P−(k) is P0.
P
0
=P
−(k)=P−(k+1) (9)
The following Equation (10) is obtained by solving the Kalman gain g(k) with simultaneous equations of the above Equations (3) and (6) applied with the above Equation (9) and the above Equation (4) applied with the above Equation (9). In the following Equation (10), the Kalman gain g(k) at the convergence state k=∞ is set to g. In addition, in the approximation on the right side, it is assumed that σsys<<σmeas holds because the passing band is very low in the convergence state of the Kalman filter 120.
From the above Equation (10), since σsys2=g2σmeas2 in the convergence state, the gain GA1=g2. If the relationship between a desired filter characteristic for extracting the DC component and the Kalman gain g is known, the gain GA1 may be set so as to obtain the desired filter characteristic.
The following Equation (11) is obtained by obtaining a final transfer function when time has elapsed from the above Equations (2) and (5), applying bilinear transformation to the transfer function, obtaining a cutoff frequency fc of the low-pass filter characteristic included in the transfer function, and solving for the Kalman gain g. fs is a sampling frequency (operating frequency) of the Kalman filter 120. In the approximation on the right side of the following Equation (11), fc<<fs is set.
From the above Equation (11), the gain GA1=g2 may be obtained by the following Equation (12). In the following Equation (12), a desired cutoff frequency (target cutoff frequency) to be finally obtained in the convergence state is set to fc.
The third estimation unit 160 estimates the variation of the zero point (DC offset) due to the temperature fluctuation. The third estimation unit 160 increases the system noise σsys in a case where there is a temperature change and returns the Kalman filter 120 from the converging state to an estimation state. Specifically, the third estimation unit 160 includes a delay unit 161, a subtraction processing unit 162, a low-pass filter 163, a gain processing unit 164, a square arithmetic processing unit 165, a multiplication processing unit 166, and an addition processing unit 167.
The delay unit 161 and the subtraction processing unit 162 obtain a difference between a detection signal TS at a time k of a temperature sensor (for example, a temperature sensor 190 in
The gain processing unit 164 multiplies the signal from the low-pass filter 163 by a gain GA5. The square arithmetic processing unit 165 squares the multiplied signal. The multiplication processing unit 166 multiplies the signal after the squaring by the index value Vn2 of the floor noise from the second estimation unit 150. The addition processing unit 167 adds the output of the multiplication processing unit 166 and the output of the gain processing unit 115 and outputs the result as the variance σsys2 of the system noise to the Kalman filter 120.
The gain GA 5 is set by the following Equation (13). TSEN is sensitivity (digi/° C.) of the temperature sensor, TCOEFF is a temperature coefficient of the gyro sensor (dps/° C.), and SEN is sensitivity (digit/dps) of the gyro sensor.
Hereinafter, with reference to
The variance σmeas2 of the observation noise is obtained by the following Equation (14) from the above Equation (8).
σmeas2=Vpp2+Vn2=(1+GA4)×Vn2 (14)
If it is assumed that the noise level of the input signal PI in the convergence state of the error covariance state is Vmin (floor noise), Vn2=Vmin2. At this time, the following Expression (15) holds from the above Expression (14). In addition, at the start of the operation (before convergence), the signal PQ is the DC component DCQ of the input signal PI. If it is assumed that a possible maximum value of the DC component DCQ is Vmax (maximum zero point error), the output of the high-pass filter 141 is Vmax, the output of the square arithmetic processing unit 142 is Vmax2, and the output of the gain processing unit 144 is GA4×Vmax2. On the other hand, the output of the low-pass filter 153 becomes Vmax2, and the following Equation (16) holds. In order to simplify the calculation, the effective gain Gpeak of the peak-hold unit 143 is set to 1.
σmeas2=(1+GA4)×Vmin2 (15)
σmeas2=(1+GA4)×Vmax2 (16)
In the convergence state, the following Equation (17) holds from the above Equations (3), (6), and (10).
From the above Equations (9), (11), and (17), the following Equation (18) is obtained as the error covariance P0 in the convergence state.
If it is assumed that the state before the convergence is a state before a time constant time of a target cutoff frequency fc, the following Equation (19) is obtained as the error covariance P1 in the state before convergence.
As shown in
V
1
2
=P
1
×GA3+VOS (20)
V
0
2
=P
0
×GA3+VOS (21)
By solving the above Equations (20) and (21) as simultaneous Equations and using the above Equations (15), (16), (18), and (19), the following Equations (22) and (23) are obtained. That is, the gain GA3 of the monitoring unit 180 is set by the following Equation (22), and the offset VOS is set by the following Equation (23).
The drive circuit 30 supplies a drive signal DQ to the physical quantity transducer 12 to drive the physical quantity transducer 12. The detection circuit 60 receives the detection signal TQ from the physical quantity transducer 12 and detects a physical quantity signal corresponding to the physical quantity. The processing circuit 100 (abnormality detection unit 170) performs an abnormality detection of the physical quantity measuring apparatus using the physical quantity signal as the input signal PI.
Specifically, the physical quantity transducer 12 is an element or a device for detecting a physical quantity. The physical quantity is, for example, angular velocity, angular acceleration, velocity, acceleration, distance, pressure, sound pressure, magnetic quantity or time. The circuit apparatus 300 may detect the physical quantity based on detection signals from a plurality of physical quantity transducers. For example, first to third physical quantity transducers detect the physical quantity of a first axis, a second axis, and a third axis, respectively. The physical quantities of the first axis, the second axis, and the third axis are, for example, angular velocity or angular acceleration about the first axis, the second axis, the third axis, or velocity or acceleration, and the like in the directions of the first axis, the second axis, and the third axis. The first axis, the second axis, and the third axis are, for example, an X-axis, a Y-axis, and a Z-axis. The physical quantities of only two axes out of the first to third axes may be detected.
The processing circuit 100 is realized by a processor such as a DSP (Digital Signal Processor), and the processing of each unit is realized by time division processing by DSP, for example. Alternatively, each unit of the processing circuit 100 may be configured as individual hardware (logic circuit).
The zero point estimation unit 102 dynamically changes the observation noise and the system noise based on the input signal PI and the detection signal TS (temperature detection voltage) from the temperature sensor 190 and performs Kalman filter processing based on the observation noise and system noise to estimate the DC component DCQ (DC offset and zero point) of the input signal PI. The zero point estimation unit 102 corresponds to the Kalman filter 120 and the monitoring unit 180 in
The subtraction processing unit 104 subtracts the DC component DCQ from the input signal PI and outputs the result as the signal PQ. The subtraction processing unit 121 of
The processing unit 106 performs various digital signal processing (for example, correction, integration, and the like) on the signal PQ and outputs a digital value representing a physical quantity. The type of the physical quantity output by the processing unit 106 may be the same as or different from the type of the physical quantity detected by the detection circuit 60. For example, in the gyro sensor, the detection circuit 60 detects the angular velocity, but the processing unit 106 may output the angular velocity or may output the angle obtained by integrating the angular velocity.
The gyro sensor 400 (angular velocity sensor) includes a vibrator 10, a drive circuit 30, a detection circuit 60, and a processing circuit 100.
The vibrator 10 (angular velocity detection element) is a device (physical quantity transducer) that detects a Coriolis force acting on the vibrator 10 by rotation on a predetermined axis and outputs a signal corresponding to the Coriolis force. The vibrator 10 is, for example, a piezoelectric vibrator. For example, the vibrator 10 is a double T-shaped, T-shaped, tuning-fork-type crystal vibrator, and the like. As the vibrator 10, a MEMS (Micro Electro Mechanical Systems) vibrator or the like as a silicon vibrator formed by using a silicon substrate or the like may be adopted.
The drive circuit 30 includes an amplifier circuit 32 to which a feedback signal DI from the vibrator 10 is input, a gain control circuit 40 that performs automatic gain control, and a drive signal output circuit 50 that outputs the drive signal DQ to the vibrator 10. In addition, the drive circuit 30 includes a synchronization signal output circuit 52 that outputs a synchronization signal SYC to the detection circuit 60.
The amplifier circuit 32 (I/V conversion circuit) amplifies the feedback signal DI from the vibrator 10. For example, the amplifier circuit 32 converts the signal DI of the current from the vibrator 10 into a voltage signal DV and outputs the result. This amplifier circuit 32 may be realized by an operational amplifier, a feedback resistance element, a feedback capacitor, or the like.
The drive signal output circuit 50 outputs the drive signal DQ based on the signal DV after amplification by the amplifier circuit 32. For example, in a case where the drive signal output circuit 50 outputs a rectangular wave (or sine wave) drive signal, the drive signal output circuit 50 may be realized by a comparator or the like.
The gain control circuit 40 (AGC) outputs a control voltage DS to the drive signal output circuit 50 to control the amplitude of the drive signal DQ. Specifically, the gain control circuit 40 monitors the signal DV and controls the gain of an oscillation loop. For example, in the drive circuit 30, in order to keep the sensitivity of the gyro sensor constant, it is necessary to keep the amplitude of the driving voltage supplied to a vibrating unit for driving the vibrator 10 constant. Therefore, the gain control circuit 40 for automatically adjusting the gain is provided in the oscillation loop of a drive oscillation system. The gain control circuit 40 automatically adjusts the gain variably so that the amplitude (vibration speed of the vibrating unit for driving the vibrator 10) of the feedback signal DI from the vibrator 10 becomes constant. This gain control circuit 40 may be realized by a full-wave rectifier that performs full-wave rectification of the output signal DV of the amplifier circuit 32, an integrator that performs integration processing of the output signal of the full-wave rectifier, or the like.
The synchronization signal output circuit 52 receives the signal DV after amplification by the amplifier circuit 32 and outputs the synchronization signal SYC (reference signal) to the detection circuit 60. The synchronization signal output circuit 52 includes a comparator that performs binarization processing of a sine wave (alternating current) signal DV to generate a rectangular wave synchronization signal SYC, a phase adjusting circuit (phase shifter) that adjusts the phase of the synchronization signal SYC, and the like.
The detection circuit 60 includes an amplifier circuit 64, a synchronous detection circuit 81, an A/D conversion circuit 82, and a processing circuit 100 (DSP). The amplifier circuit 64 receives first and second detection signals IQ1 and IQ2 from the vibrator 10 and performs charge-voltage conversion, differential signal amplification, gain adjustment, or the like. The synchronous detection circuit 81 performs synchronous detection based on the synchronization signal SYC from the drive circuit 30. The A/D conversion circuit 82 performs A/D conversion of the signal of the synchronous detection. The processing circuit 100 performs digital filter processing or digital correction processing (for example, zero point correction processing, sensitivity correction processing, or the like) on the digital signal (input signal PI) from the A/D conversion circuit 82.
As the electronic device 200 of the embodiment, various devices such as a digital camera (digital still camera or video camera), a biological information detection apparatus (pulse rate meter, activity meter, pedometer, health clock, and the like), a head mounted type display device, a robot, a GPS internal clock, a car navigation device, a game device, various wearable devices, a portable information terminal (a smartphone, a mobile phone, a portable game device, a tablet PC, and the like), a content-providing terminal, video equipment, audio equipment, or network-related equipment (base station, router, and the like) may be assumed. For example, in a digital camera, by using the circuit apparatus of the embodiment, camera shake correction using a gyro sensor, an acceleration sensor or the like may be realized. In addition, in a biological information detection apparatus, by using the circuit apparatus of the embodiment, it is possible to detect the biological motion of a user or the motion state by using the gyro sensor or the acceleration sensor. The circuit apparatus of the embodiment may be used for movable parts (arm and joint) or the main body part of a robot. In the robot, either a vehicle (running/walking robot) or an electronic device (non-running/non-walking robot) may be assumed. In the case of a running/walking robot, for example, the circuit apparatus of the embodiment may be used for autonomous traveling. In the network-related equipment, the circuit apparatus of the embodiment may be used as an apparatus for measuring time (absolute time and the like) or timing, for example.
In
In addition, the circuit apparatus of the embodiment may be incorporated into various vehicles such as a car, an airplane, a motorbike, a bicycle, ship or the like, for example. A vehicle is a device/apparatus that moves on the ground, the sky or the sea including a driving mechanism such as an engine, a motor, or the like, a steering mechanism such as a steering wheel, a rudder, or the like, and various electronic devices.
Although the embodiment has been described in detail as above, those skilled in the art will easily understand that many modifications may be made without deviating practically from the new matters and effects of the invention. Therefore, all such modifications are included in the scope of the invention. For example, in the specification or the drawings, terms described with broader or equivalent different terms at least once may be replaced with different terms at any point in the description or drawings. In addition, all combinations of the embodiment and modifications are included in the scope of the invention. In addition, the configurations and operations of the signal processing apparatus, the detection device, the physical quantity measuring apparatus, the electronic device, the vehicle, and the like are not limited to those described in the embodiment, and various modifications may be made.
The entire disclosure of Japanese Patent Application No. 2017-107468, filed May 31, 2017 is expressly incorporated by reference herein.
Number | Date | Country | Kind |
---|---|---|---|
2017-107468 | May 2017 | JP | national |