This application is based upon and claims the benefit of priority from Japanese Patent Application No. 2020-098552, filed on Jun. 5, 2020; the entire contents of which are incorporated herein by reference.
Embodiments of the invention generally relate to a sensor and an electronic device.
There is a sensor such as a gyro sensor or the like. It is desirable to increase the detection accuracy of the sensor and an electronic device.
According to one embodiment, a sensor includes a processor. The processor is configured to acquire a first angle value from an angle gyro sensor and acquire a first angular velocity value from an angular velocity gyro sensor, and perform at least first processing. The first processing includes outputting a second angular velocity value by correcting the first angular velocity value by using a value obtained by filtering a difference between the first angle value and a post-processing angle value. The post-processing angle value is obtained by processing the first angular velocity value.
According to one embodiment, a sensor includes a processor. The processor is configured to acquire a first angle value from an angle gyro sensor and acquire a first acceleration value from an acceleration sensor, and second processing. The second processing includes deriving a second acceleration value by correcting the first acceleration value based on a correction value based on the first angle value and a gravitational force.
According to one embodiment, an electronic device includes any one of the sensors described above, and a circuit controller configured to control a circuit based on a signal obtained from the sensor.
Various embodiments are described below with reference to the accompanying drawings.
The drawings are schematic and conceptual; and the relationships between the thickness and width of portions, the proportions of sizes among portions, etc., are not necessarily the same as the actual values. The dimensions and proportions may be illustrated differently among drawings, even for identical portions.
In the specification and drawings, components similar to those described previously or illustrated in an antecedent drawing are marked with like reference numerals, and a detailed description is omitted as appropriate.
As shown in
For example, the processor 60U is an electronic circuit (including a computer, etc.). For example, an acquisition part 65, a first processor 61, etc., are provided in the processor 60U. The acquisition part 65 is configured to acquire the first angle value θ1 and the first angular velocity value Ω1. The acquisition part 65 may be, for example, an input port (an input/output port). The first processor 61 is a functional block that performs the first processing. The processor 60U is configured to output a signal corresponding to the result of the first processing. For example, the signal may be output externally from the acquisition part 65 (e.g., the input/output port).
The first angle value θ1 is obtained from an angle gyro sensor 10. The angle gyro sensor 10 is, for example, a RIG (Rate Integrating Gyroscope). For example, the angle gyro sensor 10 is configured to directly measure an angle of a detection object. For example, the angle gyro sensor 10 can measure the angle of the detection object without an integration operation. Thus, the first angle value θ1 is obtained by the angle gyro sensor 10 directly measuring the angle of the detection object.
The first angular velocity value Ω1 is obtained from an angular velocity gyro sensor 20. The angular velocity gyro sensor 20 is, for example, a RG (Rate Gyroscope). For example, the angular velocity gyro sensor 20 is configured to detect a value that includes the angular velocity of the detection object. In addition to the angular velocity of the detection object (e.g., the true angular velocity), the first angular velocity value Ω1 that is obtained from the angular velocity gyro sensor 20 may include offset due to effects of a circuit or the like, random noise due to the effects of a circuit or the like, etc.
The angle gyro sensor 10 may be provided separately from the sensor 110. The angle gyro sensor 10 may be included in a sensor 210. The angular velocity gyro sensor 20 may be provided separately from the sensor 110. The angular velocity gyro sensor 20 may be included in the sensor 210. The sensor 210 includes the sensor 110 and at least one of the angle gyro sensor 10 or the angular velocity gyro sensor 20. The sensor 210 is, for example, an IMU (Inertial Measurement Unit). As described below, the sensor 210 may include an acceleration sensor.
The first processing is performed by a calculator included in the processor 60U. When the first processing is performed by a calculator, at least a portion of the calculator corresponds to the first processor 61 (referring to
The first processing includes outputting a second angular velocity value Ω2. In other words, the first processor 61 is configured to output the second angular velocity value Ω2. The second angular velocity value Ω2 is a value generated by correcting the first angular velocity value Ω1.
As shown in
For example, an integration processor 61a, a difference processor 61b (a complementary error calculator DF), a first filter processor 61c (a complementary filter FL1), and a correction processor 61d (a corrector COM1) are provided in the first processor 61. These processors are functional blocks that are provided in the first processor 61 (the processor 60U).
For example, the integration processor 61a derives the post-processing angle value θ1p by integrating the first angular velocity value Ω1. The post-processing angle value θ1p and the first angle value θ1 are input to the difference processor 61b. The difference processor 61b derives the difference θ1q as the angle of the difference between the post-processing angle value θ1p and the first angle value θ1. The difference θ1q that is derived is input to the first filter processor 61c. The first filter processor 61c filters the difference θ1q.
The filtering that is performed by the first filter processor 61c includes, for example, Kalman filtering (including complimentary Kalman filtering) of the difference θ1q. In complimentary Kalman filtering, it is possible to estimate the states of multiple sensor errors as a dynamic system by using, as an observed value, a sensor error obtained from the difference between outputs of the multiple sensors (e.g., the angle gyro sensor 10 and the angular velocity gyro sensor 20) that have mutually-different error characteristics.
In Kalman filtering, for example, the current state estimated value and the state predicted value of one-step subsequent are derivable from a current observed quantity of the object system and the state estimated value of one-step previous. In Kalman filtering, for example, a prediction and an update are performed each time step. In the prediction, for example, the estimated state of the current time is calculated from the estimated state of the previous time. In the update, a more accurate state is estimated by correcting the estimated value by using the observed value of the current time.
Other than the angular velocity of the detection object, for example, components (e.g., the offset, random noise, etc.) that are included in the first angular velocity value Ω1 can be derived by performing Kalman filtering of the difference θ1q. The filtering that is performed by the first filter processor 61c may include processing based on a first-principle model.
The first angular velocity value Ω1 and the value θ1r that is obtained by filtering the difference θ1q are input to the correction processor 61d. The correction processor 61d outputs the second angular velocity value Ω2 by correcting the first angular velocity value Ω1 by using the value θ1r and the first angular velocity value Ω1.
The other components (e.g., the offset, random noise, etc.) that are included in the first angular velocity value Ω1 are removed from the second angular velocity value Ω2. The second angular velocity value Ω2 is accurate. According to the embodiment, a sensor can be provided in which the accuracy can be increased.
According to the sensor 110 (or the sensor 210), an integral error is not generated in the first angle value θ1 obtained from the angle gyro sensor 10. For example, a high-bandwidth angle detection result is obtained with high accuracy and good temperature characteristics. Also, the offset is removed from the second angular velocity value Ω2 obtained by processing that uses the angle gyro sensor 10 and the angular velocity gyro sensor 20. An angular velocity detection result is obtained with high accuracy and good temperature characteristics. According to the embodiment, the angular velocity is obtained with high accuracy by combining and correcting RIG and RG.
An example of the first angular velocity value Ω1 obtained from the angular velocity gyro sensor 20 will now be described.
As shown in
As shown in
Accordingly, the temporal summation components of the offset θo and the random noise en can be derived by deriving the difference θ1q between the first angle value θ1 and the post-processing angle value θ1p obtained by processing (integrating) the first angular velocity value Ω1. Then, the second angular velocity value Ω2 is obtained with a high accuracy by correcting the first angular velocity value Ω1 by using the value θ1r obtained by filtering the difference θ1q.
In these figures, the horizontal axis is the time tm. The vertical axis of
As shown in
For example, the first angle value θ1 includes an X-axis angle value θ1x relating to the X-axis, a Y-axis angle value θ1y relating to the Y-axis, and a Z-axis angle value θ1z relating to the Z-axis. The first angular velocity value Ω1 includes an X-axis angular velocity value Ω1x relating to the X-axis, a Y-axis angular velocity value Ω1y relating to the Y-axis, and a Z-axis angular velocity value Ω1z relating to the Z-axis. The X-axis, the Y-axis, and the Z-axis are orthogonal to each other.
For example, the X-axis angular velocity value Ω1x, the Y-axis angular velocity value Ω1y, and the Z-axis angular velocity value Ω1z each are corrected. For example, the second angular velocity value Ω2 includes an X-axis angular velocity value Ω2x relating to the X-axis, a Y-axis angular velocity value Ω2y relating to the Y-axis, and a Z-axis angular velocity value Ω2z relating to the Z-axis.
In the sensor 111 as shown in
The first acceleration value G1 is obtained from an acceleration sensor 30. The acceleration sensor 30 is, for example, an acceleration sensor Acc (Accelerometer) relating to a translation. The acceleration sensor 30 may be provided separately from the sensor 110. The acceleration sensor 30 may be included in the sensor 211 (e.g., the IMU).
The first acceleration value G1 may include an X-axis acceleration value G1x relating to the X-axis, a Y-axis acceleration value G1y relating to the Y-axis, and a Z-axis acceleration value G1z relating to the Z-axis.
The second processing is performed by a calculator included in the processor 60U. When the second processing is performed by the calculator, at least a portion of the calculator corresponds to a second processor 62 (referring to
The second processing includes deriving a second acceleration value G2 by correcting the first acceleration value G1. The second acceleration value G2 may be output. The processor 60U is configured to output the result (the velocity) obtained by processing (e.g., integrating) the result (the second acceleration value G2) of the second processing. For example, the result (e.g., the signal) may be output externally from the acquisition part 65 (e.g., the input/output port).
For example, the second acceleration value G2 that relates to the three axes is obtained by correcting the first acceleration value G1 that relates to the three axes. For example, the second acceleration value G2 includes an X-axis acceleration value G1x relating to the X-axis, a Y-axis acceleration value G1y relating to the Y-axis, and a Z-axis acceleration value G2z relating to the Z-axis.
In the second processing, the second acceleration value G2 is obtained by correcting the first acceleration value G1 based on a correction value based on the first angle value θ1 and the gravitational force.
For example, the processor 60U includes the second processor 62. The second processing is performed by the second processor 62. The second processor 62 corresponds to at least a portion of the calculator included in the processor 60U. The operations that are performed by the second processor 62 may be performed by at least a portion of the first processor 61.
For example, a second filter processor 62a (an acceleration separation filter FL2) and an integration processor 62b are provided in the second processor 62. These processors are functional blocks provided in the second processor 62 (the processor 60U).
For example, the first angle value θ1 and the first acceleration value G1 are input to the second filter processor 62a. The correction value that is based on the first angle value θ1 and a gravitational force Ge is derived by the second filter processor 62a. The correction value is based on the product of the gravitational force Ge and the sine of the first angle value θ1.
For example, the value that is detected by the acceleration sensor 30 includes a gravitational force component in addition to the acceleration (the “true acceleration Gr”) of the detection object. In other words, the first acceleration value G1 is represented by sin(θ1)×Ge+Gr. For example, the second acceleration value G2 is obtained by correcting the first acceleration value G1 by using “sin(θ1)×Ge” as the correction value. The effects of the gravitational force that occur according to the rotation are removed from the second acceleration value G2. The second acceleration value G2 has high accuracy. According to the embodiment, a sensor is provided in which the accuracy can be increased.
As described above, the second processing includes separating the acceleration of the linear motion and the gravitational force change based on the rotation.
The second processing may include outputting a velocity value V2 by integrating the second acceleration value G2. For example, the second acceleration value G2 after the correction is input to the integration processor 62b. The integration processor 62b outputs the velocity value V2 obtained by integrating the second acceleration value G2.
This processing may be performed for the three axes. For example, the velocity value V2 may include an X-axis velocity value V2x relating to the X-axis, a Y-axis velocity value V2y relating to the Y-axis, and a Z-axis velocity value V2z relating to the Z-axis.
In the sensor 111 (or the sensor 211), the velocity value V2 is obtained with high accuracy in addition to the angle detection result having high accuracy (good temperature characteristics and a high bandwidth) and the angular velocity detection result having high accuracy (offset suppression and good temperature characteristics). The integral error of the velocity value V2 is suppressed, and the effects of the gravitational force and the rotation are suppressed. According to the embodiment, by combining a RIG and an Acc, the acceleration of the linear motion and the acceleration due to the gravitational force can be separated, and the velocity is obtained with high accuracy.
As shown in
For example, the second processing includes deriving the second acceleration value G2 by correcting the first acceleration value G1 based on a correction value based on the first angle value θ1 and the gravitational force Ge. The second processing may include outputting the second acceleration value G2. The correction value is based on the product of the gravitational force Ge and the sine of the first angle value θ1 (sin(θ1)×Ge). The second processing includes, for example, separating the acceleration of the linear motion and the gravitational force change based on the rotation. The second processing may include outputting the velocity value V2 generated by integrating the second acceleration value G2.
In the sensor 120 (or a sensor 220), the velocity value V2 is obtained with high accuracy in addition to the angle detection result having high accuracy (good temperature characteristics and a high bandwidth). In the velocity value V2, the integral error is suppressed, and the effects of the gravitational force and the rotation are suppressed. According to the embodiment, by combining the RIG and the Acc, the acceleration of the linear motion and the acceleration due to the gravitational force can be separated, and the velocity is obtained with high accuracy.
For example, the first movable body 10M is displaceable with respect to the first base body 10F in the X-axis, Y-axis, and Z-axis directions.
For example, the first movable body 10M includes a first electrode 11E, a second electrode 12E, a first sensing electrode 11sE, and a second sensing electrode 12sE. In the example, the direction from the first electrode 11E toward the first sensing electrode 11sE are along the X-axis direction. In the example, the direction from the second electrode 12E toward the second sensing electrode 12sE is along the Y-axis direction. The first base body 10F includes a first counter electrode 110E, a second counter electrode 12CE, a first counter sensing electrode 11CsE, and a second counter sensing electrode 12CsE. The first counter electrode 110E, the second counter electrode 12CE, the first counter sensing electrode 11CsE, and the second counter sensing electrode 12CsE respectively face the first electrode 11E, the second electrode 12E, the first sensing electrode 11sE, and the second sensing electrode 12sE. For example, comb electrode pairs are formed of these electrodes and counter electrodes.
For example, an alternating current voltage is applied to the first and second counter electrodes 110E and 12CE. The first movable body 10M is vibrated thereby. When the first movable body 10M rotates in this state, signals (a first sense signal Vs1 and a second sense signal Vs2) that correspond to the rotation are generated in the first and second counter sensing electrodes 11CsE and 12CsE. The first sense signal Vs1 is detected by a circuit 17a provided in the first control circuit 17C. The second sense signal Vs2 is detected by a circuit 17b provided in the first control circuit 17C.
The vibration state of the vibrating first movable body 10M changes when rotated by the application of an external force, etc. For example, it is considered that the change of the vibration state is due to the action of a Coriolis force. For example, the first movable body 10M is vibrated by a spring mechanism (e.g., the supporter 10S). For example, a Coriolis force due to an angular velocity Ω of the rotation acts on the first movable body 10M that is vibrating in a first direction (e.g., the X-axis direction). Thereby, a vibration component of the first movable body 10M is generated along a second direction (e.g., the Y-axis direction). The circuit 17b detects the amplitude of the vibration along the second direction. On the other hand, a Coriolis force due to the angular velocity Ω of the rotation acts on the first movable body 10M that vibrates in the second direction. Thereby, a vibration component of the first movable body 10M is generated along the first direction. The circuit 17b detects the amplitude of the vibration along the first direction. For example, the rotation angle (the first angle value θ1) corresponds to tan−1 (−Ay/Ax), wherein “Ax” is the amplitude of a first component in the first direction, and “Ay” is the amplitude of a second component in the second direction. Thus, the first angle value θ1 can be detected by the angle gyro sensor 10.
In the angle gyro sensor 10, the first control circuit 17C is configured to output, as the first angle value θ1, a signal (e.g., −Ay/Ax) generated by processing the signals (the first sense signal Vs1 and the second sense signal Vs2) corresponding to the vibrations in directions crossing the direction in which the first movable body 10M vibrates.
As shown in
As shown in
As shown in
As shown in
The second movable body 20M includes a conductive portion 21E and a conductive portion 22E. In the example, the second supporter 20S supports the conductive portion 21E of the second movable body 20M. The second movable body 20M includes a movable supporter 20MS. The movable supporter 20MS is connected to the conductive portion 21E and the conductive portion 22E. The movable supporter 20MS supports the conductive portion 22E.
The second base body 20F includes a counter conductive portion 210E and a counter conductive portion 22CE. The counter conductive portion 210E faces a protrusion of the conductive portion 21E. A comb electrode pair is formed of the counter conductive portion 210E and the conductive portion 21E. The counter conductive portion 22CE faces the conductive portion 22E.
A drive circuit 27a is provided in the second control circuit 27C. For example, an alternating current voltage is applied to the counter conductive portion 210E by the drive circuit 27a. The second movable body 20M is vibrated thereby. In the example, the vibration is along the Y-axis direction.
The vibration state of the vibrating second movable body 20M changes when an angular velocity occurs due to the application of an external force, etc. For example, it is considered that the change of the vibration state is due to the action of a Coriolis force. For example, a vibration that has a component along the X-axis direction is generated in at least one of the conductive portion 21E or the conductive portion 22E. The magnitude of the vibration having the component along the X-axis direction can be detected as a signal (e.g., the change of the electrical capacitance) generated between the counter conductive portion 22CE and the conductive portion 22E.
In the example, multiple portions are provided in the conductive portion 22E; and multiple counter conductive portions 22CE are provided. For example, the potential difference between one of the multiple portions of the conductive portion 22E and one of the multiple counter conductive portions 22CE and the potential difference between another one of the multiple portions of the conductive portion 22E and another one of the multiple counter conductive portions 22CE are detected by a detector 27b of the second control circuit 27C. The angular velocity (the first angular velocity value Ω1) is derived by the result detected by the detector 27b being processed by an angular velocity calculator 27c of the second control circuit 27C. The derived angular velocity value is output from the second control circuit 27C.
Thus, the second control circuit 27C is configured to output, as the first angular velocity value Ω1, a signal that corresponds to a vibration in a direction crossing the direction in which the second movable body 20M vibrates.
A plurality of the structures shown in
As shown in
In the example, the third base body 30F includes multiple counter electrodes 30CE. The third movable body 30M is located between the multiple counter electrodes 30CE. The third movable body 30M includes a portion that faces one of the multiple counter electrodes 30CE, and a portion that faces another one of the multiple counter electrodes 30CE. These portions function as electrodes 31E. A first capacitance C1 is formed between one of the multiple counter electrodes 30CE and the portion (the electrode 31E) that faces the one of the multiple counter electrodes 30CE. A second capacitance C2 is formed between another one of the multiple counter electrodes 30CE and the portion (the electrode 31E) that faces the other one of the multiple counter electrodes 30CE. The increase and decrease of the first capacitance C1 and the increase and decrease of the second capacitance C2 have a mutually-reversed relationship.
For example, the third control circuit 37C includes a drive circuit 37a. For example, an alternating current voltage is supplied to the third movable body 30M by the drive circuit 37a. The third movable body 30M is vibrated thereby. In the example, the direction of the vibration is the X-axis direction. The change of the first capacitance C1 and the change of the second capacitance C2 when an acceleration is applied to such a third movable body 30M is different from when the acceleration is not applied.
As shown in
A third embodiment relates to an electronic device.
As shown in
As shown in
Embodiments may include the following configurations (e.g., technological proposals).
A sensor, comprising:
a processor configured to
the first processing including outputting a second angular velocity value by correcting the first angular velocity value by using a value obtained by filtering a difference between the first angle value and a post-processing angle value,
the post-processing angle value being obtained by processing the first angular velocity value.
The sensor according to Configuration 1, wherein
the post-processing angle value is obtained by integrating the first angular velocity value.
The sensor according to Configuration 1 or 2, wherein
the filtering includes Kalman filtering of the difference.
The sensor according to Configuration 1 or 2, wherein
the filtering includes processing based on a first-principle model.
The sensor according to any one of Configurations 1 to 4, wherein
the acquiring further includes acquiring a first acceleration value from an acceleration sensor,
the processor is configured to perform at least second processing, and
the second processing includes deriving a second acceleration value by correcting the first acceleration value based on a correction value based on the first angle value and a gravitational force.
The sensor according to Configuration 5, wherein
the correction value is based on a product of the gravitational force and a sine of the first angle value.
The sensor according to Configuration 5 or 6, wherein
the second processing includes separating:
The sensor according to any one of Configurations 5 to 7, wherein
the second processing includes outputting a velocity value by integrating the second acceleration value.
The sensor according to any one of Configurations 5 to 8, further comprising:
the acceleration sensor.
The sensor according to any one of Configurations 4 to 9, wherein
the first angle value includes:
the first acceleration value includes:
the X-axis, the Y-axis, and the Z-axis are orthogonal to each other.
The sensor according to any one of Configurations 1 to 9, wherein
the first angle value includes:
the first angular velocity value includes:
the X-axis, the Y-axis, and the Z-axis are orthogonal to each other.
The sensor according to any one of Configurations 1 to 11, wherein
the first angle value is obtained by the angle gyro sensor directly measuring an angle of a detection object.
The sensor according to any one of Configurations 1 to 12, further comprising:
the angle gyro sensor,
the angle gyro sensor including
the first control circuit being configured to output, as the first angle value, a signal generated by processing a signal corresponding to a vibration in a direction crossing a vibration direction of the first movable body.
The sensor according to any one of Configurations 1 to 13, further comprising:
the angular velocity gyro sensor,
the angular velocity gyro sensor including
the second control circuit being configured to output, as the first angular velocity value, a signal corresponding to a vibration in a direction crossing a vibration direction of the second movable body.
A sensor, comprising:
a processor configured to
the second processing including deriving a second acceleration value by correcting the first acceleration value based on a correction value based on the first angle value and a gravitational force.
The sensor according to Configuration 15, wherein
the correction value is based on a product of the gravitational force and a sine of the first angle value.
The sensor according to Configuration 15 or 16, wherein
the second processing includes separating:
The sensor according to any one of Configurations 15 to 17, wherein
the second processing includes outputting a velocity value by integrating the second acceleration value.
An electronic device, comprising:
the sensor according to any one of Configurations 1 to 18; and
a circuit controller configured to control a circuit based on a signal obtained from the sensor.
The electronic device according to Configuration 19, wherein
the electronic device includes at least one of a robot or a moving body.
According to embodiments, a sensor and an electronic device can be provided in which the accuracy can be increased.
Hereinabove, exemplary embodiments of the invention are described with reference to specific examples. However, the embodiments of the invention are not limited to these specific examples. For example, one skilled in the art may similarly practice the invention by appropriately selecting specific configurations of components included in sensors such as angle gyro sensors, angular velocity gyro sensors, acceleration sensors, processors, etc., from known art. Such practice is included in the scope of the invention to the extent that similar effects thereto are obtained.
Further, any two or more components of the specific examples may be combined within the extent of technical feasibility and are included in the scope of the invention to the extent that the purport of the invention is included.
Moreover, all sensors practicable by an appropriate design modification by one skilled in the art based on the sensors described above as embodiments of the invention also are within the scope of the invention to the extent that the spirit of the invention is included.
Various other variations and modifications can be conceived by those skilled in the art within the spirit of the invention, and it is understood that such variations and modifications are also encompassed within the scope of the invention.
While certain embodiments have been described, these embodiments have been presented by way of example only, and are not intended to limit the scope of the inventions. Indeed, the novel embodiments described herein may be embodied in a variety of other forms; furthermore, various omissions, substitutions and changes in the form of the embodiments described herein may be made without departing from the spirit of the inventions. The accompanying claims and their equivalents are intended to cover such forms or modifications as would fall within the scope and spirit of the invention.
Number | Date | Country | Kind |
---|---|---|---|
2020-098552 | Jun 2020 | JP | national |