Angle-measuring method and angle-measuring gyroscope system for implementing the same
First Claim
1. An angle-measuring method for calculating an angle of rotation of a gyroscope of an angle-measuring gyroscope system, the gyroscope including a proof mass that oscillates in an x-y plane defined by mutually orthogonal x and y axes, the angle-measuring gyroscope system including a sensing module, a state observer, and an angle calculator, the sensing module being configured to detect motion of the proof mass, and to generate a set of sensing signals that correspond to the motion of the proof mass detected thereby and that indicate x and y components of a position of the proof mass, said angle-measuring method comprising:
- A) configuring the state observer to calculate a set of estimated signals based on a set of previously calculated estimated parameters, the previously calculated estimated parameters corresponding to a set of system parameters of the angle-measuring gyroscope system, the system parameters of the angle-measuring gyroscope system including x and y components of a position of the proof mass, x and y components of a velocity of the proof mass, x and y components of an error of the sensing module, and an angular rate of the gyroscope about a z-axis orthogonal to the x and y axes;
B) configuring the state observer to calculate a gain thereof using a dynamic equation associated with the gyroscope;
C) configuring the state observer to calculate a set of currently calculated estimated parameters using the dynamic equation associated with the gyroscope based on the gain calculated in step B), the sensing signals generated by the sensing module, and the estimated signals calculated in step A); and
D) configuring the angle calculator to calculate an angle of rotation of the gyroscope about the z-axis based on a position and a velocity in the currently calculated estimated parameters calculated in step C) and a stiffness coefficient of the gyroscope.
1 Assignment
0 Petitions
Accused Products
Abstract
An angle-measuring method includes: configuring a state observer to calculate a set of estimated signals based on a set of previously calculated estimated parameters; configuring the state observer to calculate a gain thereof using a dynamic equation associated with a gyroscope; configuring the state observer to calculate a set of currently calculated estimated parameters using the dynamic equation associated with the gyroscope based on the gain calculated by the state observer, a set of sensing signals generated by a sensing module, and the estimated signals calculated by the state observer; and configuring an angle calculator to calculate an angle of rotation of the gyroscope based on a position and a velocity in the currently calculated estimated parameters calculated by the state observer and a stiffness coefficient of the gyroscope. An angle-measuring gyroscope system that implements the angle-measuring method is also disclosed.
-
Citations
26 Claims
-
1. An angle-measuring method for calculating an angle of rotation of a gyroscope of an angle-measuring gyroscope system, the gyroscope including a proof mass that oscillates in an x-y plane defined by mutually orthogonal x and y axes, the angle-measuring gyroscope system including a sensing module, a state observer, and an angle calculator, the sensing module being configured to detect motion of the proof mass, and to generate a set of sensing signals that correspond to the motion of the proof mass detected thereby and that indicate x and y components of a position of the proof mass, said angle-measuring method comprising:
-
A) configuring the state observer to calculate a set of estimated signals based on a set of previously calculated estimated parameters, the previously calculated estimated parameters corresponding to a set of system parameters of the angle-measuring gyroscope system, the system parameters of the angle-measuring gyroscope system including x and y components of a position of the proof mass, x and y components of a velocity of the proof mass, x and y components of an error of the sensing module, and an angular rate of the gyroscope about a z-axis orthogonal to the x and y axes; B) configuring the state observer to calculate a gain thereof using a dynamic equation associated with the gyroscope; C) configuring the state observer to calculate a set of currently calculated estimated parameters using the dynamic equation associated with the gyroscope based on the gain calculated in step B), the sensing signals generated by the sensing module, and the estimated signals calculated in step A); and D) configuring the angle calculator to calculate an angle of rotation of the gyroscope about the z-axis based on a position and a velocity in the currently calculated estimated parameters calculated in step C) and a stiffness coefficient of the gyroscope. - View Dependent Claims (2, 3, 4, 5, 6)
-
-
7. An angle-measuring gyroscope system, comprising:
-
a gyroscope including a proof mass that oscillates in an x-y plane defined by mutually orthogonal x and y axes; a sensing module coupled to said gyroscope, and configured to detect motion of said proof mass, and to generate a set of sensing signals that correspond to the motion of said proof mass detected thereby and that indicate x and y components of a position of said proof mass; and a calculating module including a state observer coupled to said sensing module, and configured to calculate a set of estimated signals based on a set of previously calculated estimated parameters, the previously calculated estimated parameters corresponding to a set of system parameters of said angle-measuring gyroscope system, the system parameters of said angle-measuring gyroscope system including x and y components of a position of said proof mass, x and y components of a velocity of said proof mass, x and y components of an error of said sensing module, and an angular rate of said gyroscope about a z-axis orthogonal to the x and y axes, said state observer being further configured to calculate a gain thereof using a dynamic equation associated with said gyroscope, and to calculate a set of currently calculated estimated parameters using the dynamic equation associated with said gyroscope based on the gain calculated thereby, the sensing signals generated by said sensing module, and the estimated signals calculated thereby, and an angle calculator coupled to said state observer, and configured to calculate an angle of rotation of said gyroscope about the z-axis based on a position and a velocity in the currently calculated estimated parameters calculated by said state observer and a stiffness coefficient of said gyroscope. - View Dependent Claims (8, 9, 10)
-
-
11. An angle-measuring method for calculating an angle of rotation of a gyroscope of an angle-measuring gyroscope system, the gyroscope including a proof mass that oscillates in an x-y plane defined by mutually orthogonal x and y axes, the angle-measuring gyroscope system including a sensing module, a driving module, a state observer, a control signal calculator, and an angle calculator, the sensing module being configured to detect motion of the proof mass, and to generate a set of sensing signals that correspond to the motion of the proof mass detected thereby and that indicate x and y components of a position of the proof mass, the driving module being configured to generate a set of control forces based on a set of control signals for controlling oscillation of the proof mass, said angle-measuring method comprising:
-
A) configuring the state observer to calculate a set of estimated signals based on a set of previously calculated estimated parameters, the previously calculated estimated parameters corresponding to a set of system parameters of the angle-measuring gyroscope system, the system parameters of the angle-measuring gyroscope system including x and y components of a position of the proof mass, x and y components of a velocity of the proof mass, an angular rate of the gyroscope about a z-axis orthogonal to the x and y axes, x and y components of a stiffness coefficient of the gyroscope, a stiffness coefficient of a coupling effect of the gyroscope, x and y components of a damping coefficient of the gyroscope, and a damping coefficient of a coupling effect of the gyroscope; B) configuring the state observer to calculate a gain thereof using a dynamic equation associated with the gyroscope; C) configuring the control signal calculator to calculate the control signals based on a stiffness coefficient, a damping coefficient, a position, and a velocity in the previously calculated estimated parameters, and a predetermined target stiffness coefficient; D) configuring the state observer to calculate a set of currently calculated estimated parameters using the dynamic equation associated with the gyroscope based on the gain calculated in step B), the sensing signals generated by the sensing module, and the estimated signals calculated in step A); and E) configuring the angle calculator to calculate an angle of rotation of the gyroscope about the z-axis based on a position and a velocity in the currently calculated estimated parameters calculated in step D) and the predetermined target stiffness coefficient. - View Dependent Claims (12, 13, 14, 15, 16, 17, 18, 19)
-
-
20. An angle-measuring gyroscope system, comprising:
-
a gyroscope including a proof mass that oscillates in an x-y plane defined by mutually orthogonal x and y axes; a sensing module coupled to said gyroscope, and configured to detect motion of said proof mass, and to generate a set of sensing signals that correspond to the motion of said proof mass detected thereby and that indicate x and y components of a position of said proof mass; a calculating module including a state observer coupled to said sensing module, and configured to calculate a set of estimated signals based on a set of previously calculated estimated parameters, the previously calculated estimated parameters corresponding to a set of system parameters of said angle-measuring gyroscope system, the system parameters of said angle-measuring gyroscope system including x and y components of a position of said proof mass, x and y components of a velocity of said proof mass, an angular rate of said gyroscope about a z-axis orthogonal to the x and y axes, x and y components of a stiffness coefficient of said gyroscope, a stiffness coefficient of a coupling effect of said gyroscope, x and y components of a damping coefficient of said gyroscope, and a damping coefficient of a coupling effect of said gyroscope, said state observer being further configured to calculate a gain thereof using a dynamic equation associated with said gyroscope, and to calculate a set of currently calculated estimated parameters using the dynamic equation associated with said gyroscope based on the gain calculated thereby, the sensing signals generated by said sensing module, and the estimated signals calculated thereby, a control signal calculator coupled to said state observer, and configured to calculate a set of control signals based on a stiffness coefficient, a damping coefficient, a position, and a velocity in the previously calculated estimated parameters, and a predetermined target stiffness coefficient, and an angle calculator coupled to said state observer, and configured to calculate an angle of rotation of said gyroscope about the z-axis based on a position and a velocity in the currently calculated estimated parameters calculated by said state observer and a stiffness coefficient of said gyroscope; and a driving module coupled to said control signal calculator of said calculating module and said gyroscope, and configured to generate a set of control forces based on the control signals calculated by said control signal calculator for controlling oscillation of said proof mass of said gyroscope. - View Dependent Claims (21, 22, 23, 24, 25, 26)
-
Specification