Angular speed derivation device and angular speed derivation method for deriving angular speed based on output value of triaxial gyro sensor
A first converter converts an initial attitude in an Euler angle representation into an initial attitude represented by quaternion. An updating unit updates an attitude represented by quaternion by defining the initial attitude represented by quaternion as an initial value, successively substituting output values of the triaxial gyro sensor. A second converter converts the attitude represented by quaternion into an attitude in the Euler angle representation. An angular speed derivation unit derives an angular speed based on a time-dependent change in the attitude in the Euler angle representation. A controller adjusts a period of time for derivation by an initial attitude derivation unit based on a variance value of the output value of the triaxial acceleration sensor or a variance value of the output value of the triaxial gyro sensor, when the speed is lower than a threshold value.
1. An angular speed derivation device that can be installed in a mobile object, comprising:
an initial attitude derivation unit that derives an initial attitude in an Euler angle representation based on an output value of a triaxial acceleration sensor;
a first converter that converts the initial attitude in the Euler angle representation derived by the initial attitude derivation unit into an initial attitude represented by quaternion;
an updating unit that updates an attitude represented by quaternion by defining the initial attitude represented by quaternion and derived from conversion in the first converter as an initial value, and repeatedly solving a differential equation of the attitude represented by quaternion by successively substituting output values of the triaxial acceleration sensor into the differential equation;
a second converter that converts the attitude represented by quaternion and updated by the updating unit into an attitude in the Euler angle representation;
an angular speed derivation unit that derives an angular speed based on a time-dependent change in the attitude in the Euler angle representation derived from conversion in the second converter;
an acquisition unit that acquires a speed of the mobile object; and
a controller that adjusts a period of time for derivation over which the initial attitude derivation unit averages the initial attitude when the speed acquired by the acquisition unit is lower than a threshold value by multiplying a predetermined angle derivation reference period by the ratio of a current variance value of the output value of the triaxial acceleration sensor to a variance value of the output value of the triaxial acceleration sensor obtained in advance.
2. An angular speed derivation method adapted for an angular speed derivation device that can be installed in a mobile object, comprising:
deriving an initial attitude in an Euler angle representation based on an output value of a triaxial acceleration sensor;
converting the initial attitude in the Euler angle representation derived into an initial attitude represented by quaternion;
updating the attitude represented by quaternion by defining the initial attitude represented by quaternion derived from conversion as an initial value, and repeatedly solving a differential equation of the attitude represented by quaternion by successively substituting output values of a triaxial gyro sensor into the differential equation;
converting the attitude represented by quaternion as updated into an attitude in the Euler angle representation;
deriving an angular speed based on a time-dependent change in the attitude in the Euler angle representation derived from conversion;
acquiring a speed of the mobile object; and
adjusting a period of time for derivation over which the initial attitude in the Euler angle representation is averaged when the speed acquired is lower than a threshold value by multiplying a predetermined angle derivation reference period by the ratio of a current variance value of the output value of the triaxial acceleration sensor to a variance value of the output value of the triaxial acceleration sensor obtained in advance.