Attitude angle derivation device and attitude angle sensor

The attitude angle derivation device uses an integrating gyroscope and a processing unit to directly integrate rotation angles and update attitude angles, addressing integration errors and noise in gyro sensors for accurate and fast attitude angle detection.

JP7595550B2Active Publication Date: 2024-12-06KK TOSHIBA
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
JP2021181568
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2021-11-08
Publication Date
2024-12-06
Estimated Expiration
2041-11-08

AI Technical Summary

Technical Problem

Existing sensors, such as gyro sensors, face challenges in achieving highly accurate attitude angle detection due to integration errors and noise in angular velocity measurements.

Method used

An attitude angle derivation device comprising an acquisition section, storage section, and processing section that directly acquires and processes rotation angles from an angle sensor, such as an integrating gyroscope, to derive attitude angles with high accuracy by integrating the rotation angles and updating them based on temporal changes, thereby eliminating integration errors.

Benefits of technology

The device enables precise and fast detection of attitude angles by directly integrating rotation angles, reducing errors and noise, and providing accurate attitude angle updates without requiring time information, even in irregular sampling scenarios.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007595550000016
    Figure 0007595550000016
  • Figure 0007595550000017
    Figure 0007595550000017
  • Figure 0007595550000018
    Figure 0007595550000018
Patent Text Reader

Abstract

To provide an attitude angle derivation device and an attitude angle sensor that can detect an attitude angle with high accuracy.SOLUTION: An attitude angle derivation device includes an acquisition section, a storage section, and a processing section. The acquisition section can acquire a rotation angle related to a first coordinate system. The rotation angle is obtained from an angle sensor provided in an object. The storage section can store the rotation angle and an attitude angle related to a second coordinate system of the object. The processing section can acquire the rotation angle and the attitude angle, update the attitude angle on the basis of a temporal change of the rotation angle derived from the rotation angle, and output the updated attitude angle.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] An embodiment of the present invention relates to an attitude angle derivation device and an attitude angle sensor. [Background technology]

[0002] There are sensors such as gyro sensors. The sensors can detect the attitude (attitude angle) of an object. High-precision detection of the attitude angle is desirable. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2016-200512 A Summary of the Invention [Problem to be solved by the invention]

[0004] An embodiment of the present invention provides an attitude angle derivation device and an attitude angle sensor capable of detecting an attitude angle with high accuracy. [Means for solving the problem]

[0005] According to an embodiment of the present invention, an attitude angle derivation device includes an acquisition unit, a storage unit, and a processing unit. The acquisition unit is capable of acquiring a rotation angle with respect to a first coordinate system. The rotation angle is obtained from an angle sensor provided on an object. The storage unit is capable of storing an attitude angle with respect to a second coordinate system of the object and the rotation angle. The processing unit is capable of acquiring the rotation angle and the attitude angle, updating the attitude angle based on a time change of the rotation angle derived from the rotation angle, and outputting the updated attitude angle. [Brief description of the drawings]

[0006] [Figure 1] FIG. 1 is a schematic diagram illustrating an attitude angle deriving device according to the first embodiment. [Diagram 2]FIG. 2 is a schematic diagram illustrating the attitude angle deriving device according to the first embodiment. [Diagram 3] FIG. 3 is a schematic diagram illustrating the attitude angle deriving device according to the first embodiment. [Figure 4] FIG. 4 is a schematic diagram illustrating the attitude angle deriving device according to the first embodiment. [Diagram 5] 5(a) and 5(b) are schematic views illustrating the sensor according to the embodiment. [Figure 6] FIG. 6 is a schematic view illustrating an electronic device according to the third embodiment. [Figure 7] 7(a) to 7(h) are schematic diagrams illustrating applications of electronic devices. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0007] Hereinafter, embodiments of the present invention will be described with reference to the drawings. The drawings are schematic or conceptual, and the relationship between the thickness and width of each part, the size ratio between parts, etc. are not necessarily the same as those in reality. Even when the same part is shown, the dimensions and ratios of each part may be different depending on the drawing. In this specification and each drawing, elements similar to those described above with reference to the previous drawings are given the same reference numerals and detailed descriptions thereof will be omitted as appropriate.

[0008] (First embodiment) FIG. 1 is a schematic diagram illustrating an attitude angle deriving device according to the first embodiment. As shown in FIG. 1, an attitude angle deriving device 50 according to the embodiment includes an acquisition unit 58, a storage unit 55, and a processing unit 50P.

[0009] The acquiring unit 58 is capable of acquiring the angle (rotation angle DA1) obtained from the angle sensor 110. The acquiring unit 58 is, for example, an interface circuit (I / F).

[0010] As described below, the angle sensor 110 is provided on the target object. The angle sensor 110 includes, for example, an integral type gyroscope (for example, a RIG (Rate Integrating Gyroscope)). The angle sensor 110 may be a RIG.

[0011] The rotation angle DA1 can be directly detected in the angle sensor 110. In the gyroscope of the reference example, the angular velocity is detected. The angle can be detected by integrating the detected angular velocity.

[0012] In the embodiment, an integral gyroscope is applied to the angle sensor 110. This, for example, does not cause an accumulated error in integration. The angle sensor 110 is, for example, a three-axis angle sensor.

[0013] The angle (rotation angle DA1) obtained from the angle sensor 110 relates to a first coordinate system. The first coordinate system is, for example, a coordinate system based on the position where the angle sensor 110 is provided. The first coordinate system is, for example, a sensor coordinate system or a body coordinate system.

[0014] The rotation angle DA1 is, for example, a first rotation angle A x and the second rotation angle A about the second axis. y and the third rotation angle A about the third axis. z and the second axis intersects the first axis. The third axis intersects a plane that includes the first and second axes. For example, the first axis is the X-axis. The second axis is the Y-axis. The third axis is the Z-axis. For example, the second axis is perpendicular to the first axis. The third axis is perpendicular to the first and second axes.

[0015] First rotation angle A x corresponds to the angle of rotation around the first axis. The second rotation angle A y corresponds to the angle of rotation about the second axis. The third rotation angle A z corresponds to the angle of rotation about the third axis.

[0016] One time is the first time t. The rotation angle DA1 is the first rotation angle A at the first time t.x(t) , the second rotation angle A at the first time t y(t) , and the third rotation angle A at the first time t z(t) The first rotation angle A at the second time (t-1) is a time before the first time t. x The first rotation angle A x(t-1) The second rotation angle A at the second time (t-1) y The second rotation angle A y(t-1) The third rotation angle A at the second time (t-1) z The third rotation angle Az (t-1) The rotation angle DA1 is the first rotation angle A x(t-1) , the second rotation angle A y(t-1) , the third rotation angle Az (t-1) These rotation angles DA1 are supplied to the acquisition unit 58 from the angle sensor 110.

[0017] The storage unit 55 can store, for example, the rotation angle DA1 supplied from the acquisition unit 58. The storage unit 55 can store the attitude angle DA2 of the object on which the angle sensor 110 is provided. The storage unit 55 is a memory (or storage). The storage unit 55 may be a buffer memory. The storage unit 55 can store the rotation angle DA1.

[0018] The attitude angle DA2 is an attitude angle with respect to a second coordinate system of the object. The second coordinate system may be different from the first coordinate system. In one example, the second coordinate system may be, for example, an absolute coordinate system. The second coordinate system may be, for example, a coordinate system based on the direction of gravitational acceleration. The second coordinate system may be, for example, a spatial coordinate system or a reference coordinate system. The second coordinate system may be a global coordinate.

[0019] The attitude angle DA2 is, for example, a three-dimensional attitude angle. The attitude angle DA2 includes, for example, a first attitude angle φ with respect to the first attitude axis, a second attitude angle θ with respect to the second attitude axis, and a third attitude angle ψ with respect to the third attitude axis. The second attitude axis intersects with the first attitude axis. The third attitude axis intersects with a plane including the first attitude axis and the second attitude axis. For example, the second attitude axis is orthogonal to the first attitude axis. The third attitude axis is orthogonal to the first attitude axis and the second attitude axis. The first to third attitude axes may be different from the first to third axes.

[0020] The first attitude angle φ corresponds to an angle of rotation about the first attitude axis, the second attitude angle θ corresponds to an angle of rotation about the second attitude axis, and the third attitude angle ψ corresponds to an angle of rotation about the third attitude axis.

[0021] The storage unit 55 may store the attitude angle DA2 at the second time (t-1). The attitude angle DA2 is the first attitude angle φ (t-1) , the second attitude angle θ at the second time (t-1) (t-1) , and the third attitude angle ψ at the second time (t-1) (t-1) These attitude angles DA2 may be supplied from the memory unit 55 to the processing unit 50P.

[0022] The processing unit 50P acquires the rotation angle DA1 and the attitude angle DA2. For example, the processing unit 50P acquires, from the storage unit 55, the rotation angle DA1 supplied from the acquisition unit 58 to the storage unit 55. For example, the processing unit 50P acquires the attitude angle DA2 from the storage unit 55. The processing unit 50P can update the attitude angle DA2 based on a time change in the rotation angle DA1 derived from the rotation angle DA1, and output the updated attitude angle DA3.

[0023] In the embodiment, the attitude angle DA3 is derived using the angle (rotation angle DA1) obtained from the angle sensor 110. Unlike the above reference example, the attitude angle is not derived based on the angular velocity. This prevents errors from occurring when integrating the angular velocity. In the embodiment, the attitude angle can be derived (detected) with high accuracy. For example, the attitude angle can be derived at high speed.

[0024] As already explained, the first rotation angle A x(t) , second rotation angle A y(t) , the third rotation angle A z(t) , the first rotation angle A x(t-1) , second rotation angle A y(t-1) , and the third rotation angle Az (t-1) may be stored in the storage unit 55, for example.

[0025] The processing unit 50P calculates a first time change dA as the time change of the rotation angle DA1. x(t) , the second time change dA y(t) , and the third time change dA z(t) Derive.

[0026] First time change dA x(t) , the second time change dA y(t) , 3rd time change dA z(t) , the first rotation angle A x(t) , second rotation angle A y(t) , the third rotation angle A z(t) , the first rotation angle A x(t-1) , second rotation angle A y(t-1) , and the third rotation angle Az (t-1) satisfies the first equation below.

number

[0027] The processing unit 50P derives such a change over time.

[0028] The processing unit 50P updates the attitude angle DA2 at the second time (t-1) based on the derived time change and acquired from the storage unit 55. The processing unit 50P updates, for example, the first attitude angle φ (t-1) and function f1(dA x(t) ,dA y(t) ,dA z(t) ) and the sum of these, the first attitude angle φ (t) The processing unit 50P derives, for example, the second posture angle θ (t-1) And function f2(dA x(t) ,dA y(t) ,dA z(t)) and the sum of the second attitude angle θ (t) The processing unit 50P derives, for example, the third posture angle ψ (t-1) And function f3(dA x(t) ,dA y(t) ,dA z(t) ) and the sum of the third attitude angle ψ (t) Derive.

[0029] In this manner, in the embodiment, the time change of the rotation angle DA1 is derived from the angle (rotation angle DA1) obtained from the angle sensor 110. Based on the time change of the derived rotation angle DA1, the attitude angle DA2 is updated, and an updated attitude angle DA3 is derived. The attitude angle DA3 is, for example, a first attitude angle φ (t) , third attitude angle θ (t) and third attitude angle ψ (t) Includes.

[0030] Below, some examples of the processing unit 50P will be described. FIG. 2 is a schematic diagram illustrating the attitude angle deriving device according to the first embodiment. 2, in an attitude angle derivation device 50A according to the embodiment, a processing unit 50P may include a first calculation portion 51. The first calculation portion 51 is capable of deriving a time change of a rotation angle DA1. In the first calculation portion 51, the calculation of the above-mentioned first formula is performed.

[0031] The processing unit 50P may further include a second calculation portion 52. The time change derived by the first calculation portion 51 is supplied to the second calculation portion 52. The second calculation portion 52 is capable of deriving a change in the attitude angle based on the time change derived by the first calculation portion 51 and the attitude angle DA2 acquired from the storage unit 55.

[0032] The change in the attitude angle is, for example, a first attitude angle change dφ (t) , second attitude angle change dθ (t) , and the third attitude angle change dψ (t) First attitude angle change dφ (t) , second attitude angle change dθ (t) , and the third attitude angle change dψ (t)satisfies the second equation below.

number

[0033] The processing unit 50P may further include a third calculation portion 53. The change in attitude angle derived by the second calculation portion 52 is supplied to the third calculation portion 53. The third calculation portion 53 can add the change in attitude angle derived by the second calculation portion 52 and the attitude angle DA2 acquired from the storage unit 55 to derive an updated attitude angle DA3.

[0034] For example, the third calculation portion 53 calculates the following third formula.

number

[0035] In this way, the processing unit 50P (for example, the third calculation unit 53) calculates the first attitude angle φ at the first time t as the updated attitude angle DA3. (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) The first attitude angle φ (t) , second attitude angle θ (t) , and the third attitude angle ψ (t) satisfies the above formula 3. The result of the calculation of formula 3 corresponds to the attitude angle DA3 to be derived.

[0036] In the embodiment, the processing unit 50P (for example, the third calculation part 53) may supply the updated attitude angle DA3 to the storage unit 55. The storage unit 55 can store the updated attitude angle DA3. The above process may be repeatedly performed. The attitude angle at any later time may be derived using the updated attitude angle DA3.

[0037] In an embodiment, as described above, Euler angles may be used. In an embodiment, quaternions may be applied as attitude angles as follows:

[0038] For example, the attitude angle DA2 can be expressed by a first quaternion value α, a second quaternion value β, a third quaternion value γ, and a fourth quaternion value δ. For example, the attitude angle DA2 includes the first quaternion value α, the second quaternion value β, the third quaternion value γ, and the fourth quaternion value δ.

[0039] FIG. 3 is a schematic diagram illustrating the attitude angle deriving device according to the first embodiment. 3, in an attitude angle derivation device 50B according to the embodiment, a processing unit 50P includes first to third calculation portions 51 to 53. The first calculation portion 51 performs calculations similar to those described above.

[0040] The attitude angle DA2 is the first quaternion value α (t-1) , the second quaternion value β at the second time (t-1) (t-1) , the third quaternion value γ at the second time (t-1) (t-1) , and the fourth quaternion value δ at the second time (t-1) (t-1) These quaternion values ​​are supplied to the processing unit 50P (the second calculation portion 52 and the third calculation portion 53).

[0041] The processing unit 50P (second calculation unit 52) ​​calculates a first quaternion value change dα as a change in the attitude angle DA2. (t) , the second quaternion value change dβ (t) , the third quaternion value change dγ (t) , and the fourth quaternion value change dδ (t) Derive.

[0042] First quaternion value change dα (t) , the second quaternion value change dβ (t) , the third quaternion value change dγ (t) , and the fourth quaternion value change dδ (t) satisfies the following fourth equation.

number

[0043] For example, the second calculation unit 52 calculates the time change of the rotation angle (first time change dA x(t) , the second time change dA y(t) , and the third time change dA z(t) ) and the attitude angle DA2 acquired from the storage unit 55, the above-mentioned fourth equation is used to perform the calculation.

[0044] The processing unit 50P (third calculation portion 53) calculates the first quaternion value α at the first time t as the updated attitude angle DA3. (t) , the second quaternion value β at the first time t (t) , the third quaternion value γ at the first time t (t) , and the fourth quaternion value δ at the first time t (t) Derive.

[0045] The first quaternion value α at the first time t (t) , the second quaternion value β at the first time t (t) , the third quaternion value γ at the first time t (t) , and the fourth quaternion value δ at the first time t (t) satisfies the following fifth equation.

number

[0046] In the third calculation section 53, the calculation of the above-mentioned formula 5 is performed, and the first quaternion value α (t) , the second quaternion value β (t) , the third quaternion value γ (t) , and the fourth quaternion value δ (t) is derived.

[0047] Quaternion values ​​may be converted to Euler angles as described below.

[0048] FIG. 4 is a schematic diagram illustrating the attitude angle deriving device according to the first embodiment. 4, in an attitude angle derivation device 50C according to the embodiment, a processing unit 50P includes a fourth calculation part 54. The configuration of the attitude angle derivation device 50C other than this may be similar to that of the attitude angle derivation device 50B.

[0049] In the attitude angle derivation device 50C, the processing unit 50P (fourth calculation part 54) calculates a first quaternion value α (t) , the second quaternion value β at the first time t (t) , the third quaternion value γ at the first time t (t) , and the fourth quaternion value δ at the first time t (t) Based on this, the first attitude angle φ at the first time t is calculated as an updated attitude angle DA3. (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) Derive.

[0050] First attitude angle φ at the first time t (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) satisfies the following sixth equation.

number

[0051] For example, the calculation of the sixth formula above is performed by the fourth calculation unit 54. This converts the quaternion values ​​into Euler angles.

[0052] In the embodiment, for example, a digital arithmetic device may be applied as the processing unit 50P. In the embodiment, at least a part of the processing unit 50P may include an analog circuit. In the embodiment, the configuration of the processing unit 50P is arbitrary.

[0053] In the embodiment, the updated attitude angle DA3 may be output via the acquisition unit 58 (for example, an interface). The acquisition unit 58 may function as an output unit.

[0054] Second embodiment An attitude angle sensor 210 according to the second embodiment (see FIGS. 1 to 4) includes an attitude angle derivation device according to the embodiment (attitude angle derivation devices 50 to 50C, etc.) and an angle sensor 110. According to the attitude angle sensor 210 according to the embodiment, it is possible to provide an attitude angle sensor capable of detecting an attitude angle with high accuracy.

[0055] An example of the angle sensor 110 will now be described. 5(a) and 5(b) are schematic views illustrating the sensor according to the embodiment. Fig. 5(a) is a plan view. Fig. 5(b) is a cross-sectional view taken along line A1-A2 in Fig. 5(a). As shown in Fig. 5(a) and Fig. 5(b), the angle sensor 110 according to the embodiment includes a base 60, a structure 60A, and a control device 70. The angle sensor 110 is provided on an object 90. For example, the angle sensor 110 is fixed to the object 90.

[0056] The base 60 includes a first surface 60F. The structure 60A is, for example, a RIG.

[0057] The structure 60A includes a movable member 10. The movable member 10 is capable of vibrating. The vibration of the movable member 10 includes a first component and a second component. The first component is a component along a first direction D1. The second component is a component along a second direction D2. The first direction D1 is along the first surface 60F. The second direction D2 intersects with the first direction D1 and is along the first surface 60F.

[0058] The first surface 60F is defined as the X1-Y1 plane. One direction within the X1-Y1 plane is defined as the X1 axis direction. A direction along the X1-Y1 plane and perpendicular to the X1 axis direction is defined as the Y1 axis direction. A direction perpendicular to the X1 axis direction and the Y1 axis direction is defined as the Z1 axis direction. The first direction D1 is, for example, the X1 axis direction. The second direction D2 is, for example, the Y1 axis direction.

[0059] The control device 70 is capable of outputting the rotation angle Av1 of the movable member 10 obtained based on the first component and the second component.

[0060] For example, the control device 70 detects the amplitude of the first component and the amplitude of the second component of the vibration of the movable member 10. The ratio of these amplitudes corresponds to the rotation angle Av1.

[0061] As shown in FIG. 5(a) and FIG. 5(b), the structure 60A includes, for example, a fixed portion 10F and a connecting portion 10S. The fixed portion 10F is fixed to the base 60. The connecting portion 10S is supported by the fixed portion 10F. The connecting portion 10S is connected to the movable member 10. In this example, in the X1-Y1 plane, the movable member 10 is provided around the fixed portion 10F. The movable member 10 is annular. The movable member 10 is supported by a plurality of connecting portions 10S. A gap g1 is provided between the movable member 10 and the base 60. The connecting portion 10S has, for example, a bent shape. The connecting portion 10S may have, for example, a meandering shape. The connecting portion 10S is, for example, a spring structure. The connecting portion 10S is deformable.

[0062] The movable member 10 and the connection portion 10S are, for example, conductive.

[0063] As shown in FIG. 5(a) and FIG. 5(b), for example, the structure 60A includes a first opposing electrode member 20M. In this example, a plurality of first opposing electrode members 20M are provided. The vibration of the movable member 10 may be controlled by the plurality of first opposing electrode members 20M. The vibration of the movable member 10 may be controlled by a voltage (e.g., a voltage including an AC component) applied to the first opposing electrode member 20M. The voltage is applied between the first opposing electrode member 20M and the movable member 10, for example.

[0064] When the vibrating movable member 10 rotates due to an external force or the like, the vibration state changes. The change in the vibration state is considered to be due to, for example, the action of Coriolis force. For example, the movable member 10 vibrates due to a spring mechanism (for example, the connection portion 10S). A Coriolis force due to the angular velocity Ω of rotation acts on the movable member 10 vibrating in the first direction D1. This generates a vibration component along the second direction D2 in the movable member 10. The control device 70 detects the amplitude of the vibration along the second direction D2. Meanwhile, a Coriolis force due to the angular velocity Ω of rotation acts on the movable member 10 vibrating in the second direction D2. This generates a vibration component along the first direction D1 in the movable member 10. The control device 70 detects the amplitude of the vibration along the first direction D1. For example, when the amplitude of the first component in the first direction D1 is "A1" and the amplitude of the second component in the second direction D2 is "A2", the rotation angle is, for example, tan -1 Corresponds to (-A2 / A1).

[0065] A rotation angle (for example, rotation angle Av1) can be obtained by such angle sensor 110. By determining the rotation angles with respect to a plurality of different axes, the rotation angle DA1 illustrated in FIG.

[0066] In the embodiment, for example, instead of using the angular velocity, the rotation angle (angle) is input directly to the attitude angle derivation device. This makes it possible to derive the attitude angle. For example, in the reference example in which the angular velocity is used, drift or high-frequency noise due to integration error is likely to occur. In the embodiment, the drift or high-frequency noise is suppressed, making it possible to detect the attitude angle with high accuracy. In the embodiment, no time information is required to derive the attitude angle. This makes it possible to detect the attitude angle with high accuracy even in non-periodic sampling.

[0067] Third embodiment The third embodiment relates to an electronic device. The electronic device may be, for example, at least a part of the object 90. FIG. 6 is a schematic view illustrating an electronic device according to the third embodiment. As shown in Fig. 6, an electronic device 310 according to the embodiment includes a sensor according to the embodiment and a circuit control unit 170. In the example of Fig. 6, an attitude angle sensor 210 (and an angle sensor 110) is depicted as the sensor. The circuit control unit 170 can control a circuit 180 based on a signal S1 obtained from the sensor. The circuit 180 is, for example, a control circuit for a drive device 185. According to the embodiment, the circuit 180 for controlling the drive device 185 can be controlled with high accuracy based on a highly accurate detection result.

[0068] 7(a) to 7(h) are schematic diagrams illustrating applications of electronic devices. As shown in FIG. 7(a), the electronic device 310 may be at least a part of a robot. As shown in FIG. 7(b), the electronic device 310 may be at least a part of a machine robot installed in a manufacturing factory or the like. As shown in FIG. 7(c), the electronic device 310 may be at least a part of an automatic guided vehicle in a factory or the like. As shown in FIG. 7(d), the electronic device 310 may be at least a part of a drone (unmanned aerial vehicle). As shown in FIG. 7(e), the electronic device 310 may be at least a part of an airplane. As shown in FIG. 7(f), the electronic device 310 may be at least a part of a ship. As shown in FIG. 7(g), the electronic device 310 may be at least a part of a submarine. As shown in FIG. 7(h), the electronic device 310 may be at least a part of a car. The electronic device 310 may include, for example, at least one of a robot and a moving object.

[0069] The embodiment may include the following configurations (e.g., technical solutions). (Configuration 1) an acquisition unit capable of acquiring a rotation angle with respect to a first coordinate system, the rotation angle being acquired from an angle sensor provided on an object; a storage unit capable of storing an attitude angle of the object with respect to a second coordinate system and the rotation angle; a processing unit capable of acquiring the rotation angle and the attitude angle, updating the attitude angle based on a time change of the rotation angle derived from the rotation angle, and outputting the updated attitude angle; An attitude angle deriving device comprising:

[0070] (Configuration 2) 2. The attitude angle deriving device according to configuration 1, wherein the angle sensor includes an integral gyroscope.

[0071] (Configuration 3) the angle sensor includes a vibratable movable member, the vibration of the movable member including a first component along a first direction and a second component along a second direction intersecting the first direction; 3. The attitude angle deriving device according to configuration 1 or 2, wherein the angle sensor is capable of outputting, as the rotation angle, a rotation angle of the movable member obtained based on the first component and the second component.

[0072] (Configuration 4) The processing unit includes a first calculation unit, 4. The attitude angle deriving device according to any one of configurations 1 to 3, wherein the first calculation portion is capable of deriving the time change of the rotation angle.

[0073] (Configuration 5) The processing unit further includes a second calculation unit, The attitude angle derivation device according to configuration 4, wherein the second calculation unit is capable of deriving a change in the attitude angle based on the time change derived by the first calculation unit and the attitude angle acquired from the storage unit.

[0074] (Configuration 6) The processing unit further includes a third calculation unit, The attitude angle derivation device according to configuration 5, wherein the third calculation unit is capable of deriving the updated attitude angle by adding a change in the attitude angle derived by the second calculation unit and the attitude angle acquired from the storage unit.

[0075] (Configuration 7) The processing unit supplies the updated attitude angle to the storage unit, 7. The attitude angle deriving device according to any one of configurations 1 to 6, wherein the storage unit is capable of storing the updated attitude angle.

[0076] (Configuration 8) the rotation angles include a first rotation angle about a first axis, a second rotation angle about a second axis, and a third rotation angle about a third axis; the second axis intersects with the first axis, 8. The attitude angle deriving device according to any one of configurations 1 to 7, wherein the third axis intersects with a plane including the first axis and the second axis.

[0077] (Configuration 9) the second axis is perpendicular to the first axis, 9. The attitude angle deriving device according to configuration 8, wherein the third axis is perpendicular to the first axis and the second axis.

[0078] (Configuration 10) The rotation angle is the first rotation angle A at the first time t. x(t) , the second rotation angle A at the first time t y(t) , and the third rotation angle A at the first time t z(t) and The processing unit calculates a first time change dA as the time change of the rotation angle. x(t) , the second time change dA y(t) And the third time change dA z(t) Derive The first time change dA x(t) , the second time change dA y(t) , the third time change dA z(t) , the first rotation angle A x(t) , the second rotation angle A y(t) , the third rotation angle A z(t) , the first rotation angle A at a second time (t-1) before the first time t x(t-1) , the second rotation angle A at the second time (t-1) y(t-1) , and the third rotation angle Az at the second time (t-1). (t-1) teeth,

number

[0079] (Configuration 11) the attitude angles include a first attitude angle about a first attitude axis, a second attitude angle about a second attitude axis, and a third attitude angle about a third attitude axis; the second attitude axis intersects with the first attitude axis, 11. The attitude angle deriving device according to configuration 10, wherein the third attitude axis intersects with a plane including the first attitude axis and the second attitude axis.

[0080] (Configuration 12) the second attitude axis is perpendicular to the first attitude axis, 12. The attitude angle deriving device according to configuration 11, wherein the third attitude axis is perpendicular to the first attitude axis and the second attitude axis.

[0081] (Configuration 13) The attitude angle is the first attitude angle φ at the second time (t-1). (t-1) , the second attitude angle θ at the second time (t-1) (t-1) , and the third attitude angle ψ at the second time (t-1). (t-1) Including, The processing unit calculates a first attitude angle change dφ as the change in attitude angle. (t) , second attitude angle change dθ (t) , and the third attitude angle change dψ (t) Derive The first attitude angle change dφ (t) , the second attitude angle change dθ (t) , and the third attitude angle change dψ (t) teeth,

number

[0082] (Configuration 14) The processing unit calculates the first attitude angle φ at the first time t as the updated attitude angle. (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) Derive the first attitude angle φ at the first time t (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) teeth,

number

[0083] (Configuration 15) 11. The attitude angle deriving device according to configuration 10, wherein the attitude angle includes a first quaternion value, a second quaternion value, a third quaternion value, and a fourth quaternion value.

[0084] (Configuration 16) The attitude angle is the first quaternion value α (t-1) , the second quaternion value β at the second time (t-1) (t-1) , the third quaternion value γ (t-1) , and the fourth quaternion value δ at the second time (t-1). (t-1) Including, The processing unit calculates a first quaternion value change dα as the change in the attitude angle. (t) , the second quaternion value change dβ (t) , the third quaternion value change dγ (t) , and the fourth quaternion value change dδ (t) Derive The first quaternion value change dα (t) , the second quaternion value change dβ (t) , the third quaternion value change dγ (t) , and the fourth quaternion value change dδ (t) teeth,

number

[0085] (Configuration 17) The processing unit calculates the first quaternion value α at the first time t as the updated attitude angle. (t) , the second quaternion value β at the first time t (t) , the third quaternion value γ (t) , and the fourth quaternion value δ at the first time t (t) Derive The first quaternion value α at the first time t (t) , the second quaternion value β at the first time t (t) , the third quaternion value γ (t) , and the fourth quaternion value δ at the first time t (t) teeth,

number

[0086] (Configuration 18) The processing unit calculates the first quaternion value α at the first time t. (t) , the second quaternion value β at the first time t (t) , the third quaternion value γ (t) , and the fourth quaternion value δ at the first time t (t) Based on the above, the first attitude angle φ at the first time t is set as the updated attitude angle. (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) Derive the first attitude angle φ at the first time t (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) teeth,

number

[0087] (Configuration 19) An attitude angle deriving device according to any one of configurations 1 to 18, The angle sensor; An attitude angle sensor comprising:

[0088] According to the embodiment, it is possible to provide an attitude angle derivation device and an attitude angle sensor capable of detecting an attitude angle with high accuracy.

[0089] In this specification, "vertical" and "parallel" do not only mean strictly vertical and strictly parallel, but also include, for example, variations in the manufacturing process, and may mean substantially vertical and substantially parallel.

[0090] The embodiments of the present invention have been described above with reference to specific examples. However, the present invention is not limited to these specific examples. For example, the specific configurations of the elements included in the attitude angle derivation device and the attitude angle sensor are within the scope of the present invention as long as a person skilled in the art can implement the present invention in a similar manner and obtain similar effects by appropriately selecting them from a known range.

[0091] Furthermore, any combination of two or more elements of each of the specific examples, within the scope of technical feasibility, is also included within the scope of the present invention as long as it includes the gist of the present invention.

[0092] In addition, all attitude angle derivation devices and attitude angle sensors that can be implemented by a person skilled in the art through appropriate design modifications based on the attitude angle derivation devices and attitude angle sensors described above as embodiments of the present invention also fall within the scope of the present invention as long as they include the gist of the present invention.

[0093] In addition, within the scope of the concept of the present invention, a person skilled in the art may conceive of various modifications and alterations, and it will be understood that these modifications and alterations also fall within the scope of the present invention.

[0094] Although some embodiments of the present invention have been described, these embodiments are presented as examples and are not intended to limit the scope of the invention. These novel embodiments can be implemented in various other forms, and various omissions, substitutions, and modifications can be made without departing from the spirit of the invention. These embodiments and their modifications are included in the scope and spirit of the invention, and are included in the scope of the invention and its equivalents described in the claims. [Explanation of symbols]

[0095] 10... Movable member, 10F... Fixed part, 10S... Connection part, 20M... Counter electrode member, 50, 50A to 50C... Attitude angle derivation device, 50P... Processing part, 51 to 54... First to fourth calculation parts, 55... Memory part, 58... Acquisition part, 60... Base body, 60A... Structure, 60F... First surface, 70... Control device, 90... Object, α, β, γ, δ... Quaternion value, θ, φ, ψ... Attitude angle, 110... Angle sensor, 170... Circuit control part, 180... Circuit, 185... Drive device, 210... Attitude angle sensor, 310... Electronic device, Av1... Rotation angle, A x , A y , A z ...1st to 3rd rotation angles, D1, D2...1st and 2nd directions, DA1...rotation angle, DA2, DA3...attitude angle, S1...signal, dα, dβ, dγ, dδ...quaternion value change, dθ, dφ, dψ...attitude angle change, dA x , dA y , dA z …Time change, g1…Gap, t…First time

Claims

1. an acquisition unit capable of acquiring a rotation angle with respect to a first coordinate system, the rotation angle being acquired from an angle sensor provided on an object; a storage unit capable of storing an attitude angle of the object with respect to a second coordinate system and the rotation angle; a processing unit capable of acquiring the rotation angle and the attitude angle, updating the attitude angle based on a time change of the rotation angle derived from the rotation angle, and outputting the updated attitude angle; An attitude angle deriving device comprising:

2. The attitude angle deriving device according to claim 1 , wherein the angle sensor includes an integral gyroscope.

3. the rotation angles include a first rotation angle about a first axis, a second rotation angle about a second axis, and a third rotation angle about a third axis; the second axis intersects with the first axis, The attitude angle deriving device according to claim 1 , wherein the third axis intersects with a plane including the first axis and the second axis.

4. the second axis is perpendicular to the first axis, The attitude angle deriving device according to claim 3 , wherein the third axis is perpendicular to the first axis and the second axis.

5. The rotation angle is the first rotation angle A at the first time t. x(t) , the second rotation angle A at the first time t y(t) , and the third rotation angle A at the first time t z(t) and The processing unit calculates a first time change dA as the time change of the rotation angle. x(t) , second time change dA y(t) And the third time change dA z(t) Derive The first time change dA x(t) , the second time change dA y(t) , the third time change dA z(t) , the first rotation angle A x(t) , the second rotation angle A y(t) , the third rotation angle A z(t) , the first rotation angle A at a second time (t-1) before the first time t x(t-1) , the second rotation angle A at the second time (t-1) y(t-1) , and the third rotation angle Az at the second time (t-1). (t-1) teeth, [0010] The attitude angle deriving device according to claim 4 , which satisfies the above.

6. the attitude angles include a first attitude angle about a first attitude axis, a second attitude angle about a second attitude axis, and a third attitude angle about a third attitude axis, the second attitude axis intersects with the first attitude axis, The attitude angle deriving device according to claim 5 , wherein the third attitude axis intersects with a plane including the first attitude axis and the second attitude axis.

7. the second attitude axis is perpendicular to the first attitude axis, The attitude angle deriving device according to claim 6 , wherein the third attitude axis is perpendicular to the first attitude axis and the second attitude axis.

8. The attitude angle is the first attitude angle φ at the second time (t-1). (t-1) , the second attitude angle θ at the second time (t-1) (t-1) , and the third attitude angle ψ at the second time (t−1). (t-1) Including, The processing unit calculates a first attitude angle change dφ as the change in attitude angle. (t) , second attitude angle change dθ (t) , and the third attitude angle change dψ (t) Derive The first attitude angle change dφ (t) , the second attitude angle change dθ (t) , and the third attitude angle change dψ (t) teeth, [0025] The attitude angle deriving device according to claim 7 , which satisfies the above.

9. The processing unit calculates the first attitude angle φ at the first time t as the updated attitude angle. (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) Derive the first attitude angle φ at the first time t (t) , the second attitude angle θ at the first time t (t) , and the third attitude angle ψ at the first time t (t) teeth, [0030] 9. The attitude angle deriving device according to claim 8, wherein the above formula is satisfied.

10. The attitude angle deriving device according to claim 5 , wherein the attitude angle includes a first quaternion value, a second quaternion value, a third quaternion value, and a fourth quaternion value.

11. An attitude angle deriving device according to any one of claims 1 to 10, The angle sensor; An attitude angle sensor comprising:

Citation Information

Patent Citations

  • Micro parallel link mechanism

    JP1999033944A

  • Device, system, method and program for calculation of attitude information

    JP2011185669A

  • Acquisition method and acquisition device of angular velocity on gyro sensor

    JP2016200512A

  • Method and device for processing the wearing condition of a wearable device

    JP2017513130A