METHOD FOR CREATING CORRECTION PARAMETER FOR POSTURE DETECTING DEVICE, DEVICE FOR CREATING CORRECTION PARAMETER FOR POSTURE DETECTING DEVICE, AND POSTURE DETECTING DEVICE

• US 20110202300A1
• Filed: 11/12/2009
• Published: 08/18/2011
• Est. Priority Date: 11/13/2008
• Status: Abandoned Application

• Current Assignee: Seiko Epson Corporation (Seiko Group)
• Original Assignee: Epson Toyocom Corporation (Seiko Group)
• Inventors: Udagawa, Hirofumi, Kobayashi, Yoshihiro
• Application Number:
  US13/126,446
• Publication Number:
  US 20110202300A1
• Time in Patent Office: Days
• US Class Current: 702/95
• CPC Class Codes: G01B 21/045 Correction of measurements G01B9/02055 takes precedence
• CPC Class Codes: G01C 19/56 Turn-sensitive devices using vibrating masses, e.g. vibratory angular rate sensors based on Coriolis forces
• CPC Class Codes: G01C 25/005 initial alignment, calibration or starting-up of inertial devices
• CPC Class Codes: G01P 21/00 Testing or calibrating of apparatus or devices covered by the preceding groups
• CPC Class Codes: G06F 3/012 Head tracking input arrangements

Abstract

A turntable (230) is installed so that an upper side (231) of the turntable is horizontal (S10). A posture detection device (1) is secured on a side (211) of a cubic jig (210) so that an X-axis (first axis) perpendicularly intersects a side (212) (second side), a Y-axis (second axis) perpendicularly intersects a side (213) (third side), and a Z-axis (third axis) perpendicularly intersects the side (211) (first side) (S12). The side of the cubic jig opposite to the side (212), (213), or (211) is sequentially secured on the upper side of the turntable (S14, S20, and S26). Detection values of the posture detection device are acquired in a state in which the turntable is stationary or rotated at a predetermined angular velocity (S16, S18, S22, S24, S28, and S30), and correction parameters are created (S32).

Claims

1-8. -8. (canceled)

9. A correction parameter creation method that creates correction parameters of a correction expression that corrects detection values of a posture detection device to detection values in an orthogonal coordinate system having a first axis, a second axis, and a third axis that perpendicularly intersect as coordinate axes, the posture detecting device including a first sensor, a second sensor, and a third sensor that are mounted so that their detection axes are almost parallel to the first axis, the second axis, and the third axis, respectively, and detect an angular velocity or an acceleration, and detecting a posture of an object based on detection signals from the first sensor, the second sensor, and the third sensor, the correction parameter creation method comprising:

a step of installing a turntable so that an upper side of the turntable is horizontal;

a step of securing the posture detection device on a first side of a jig that is formed in a shape of a rectangular parallelepiped and includes the first side, a second side, and a third side that perpendicularly intersect so that the first axis perpendicularly intersects the second side, the second axis perpendicularly intersects the third side, and the third axis perpendicularly intersects the first side;

a first detection value acquisition step of securing a side of the jig opposite to the second side on the upper side of the turntable, and acquiring the detection values of the posture detection device in a state in which the turntable is stationary or rotated at a predetermined angular velocity;

a second detection value acquisition step of securing a side of the jig opposite to the third side on the upper side of the turntable, and acquiring the detection values of the posture detection device in a state in which the turntable is stationary or rotated at a predetermined angular velocity;

a third detection value acquisition step of securing a side of the jig opposite to the first side on the upper side of the turntable, and acquiring the detection values of the posture detection device in a state in which the turntable is stationary or rotated at a predetermined angular velocity; and

a correction parameter creation step of creating the correction parameters based on the acquired detection values.

10. The correction parameter creation method according to claim 9,

wherein the correction expression includes a first correction matrix, a second correction matrix, and a third correction matrix as the correction parameters, the first correction matrix, the second correction matrix, and the third correction matrix correcting the detection values of the first sensor, the second sensor, and the third sensor to the detection values in the orthogonal coordinate system, the correction expression being the sum of three matrices obtained by the product of the first correction matrix and a matrix that includes a digital value obtained by A/D-converting the detection value of the first sensor as an element, the product of the second correction matrix and a matrix that includes a digital value obtained by A/D-converting the detection value of the second sensor as an element, and the product of the third correction matrix and a matrix that includes a digital value obtained by A/D-converting the detection value of the third sensor as an element.

11. The correction parameter creation method according to claim 10,

wherein the first correction matrix is an inverse matrix of a rotation matrix that transforms the detection axis of the first sensor into the first axis, the second correction matrix is an inverse matrix of a rotation matrix that transforms the detection axis of the second sensor into the second axis, and the third correction matrix is an inverse matrix of a rotation matrix that transforms the detection axis of the third sensor into the third axis.

12. The correction parameter creation method according to claim 10,

wherein the correction parameter creation step includes:

calculating installation angle errors of the second sensor and the third sensor around the first axis based on the detection values acquired in the first detection value acquisition step;

calculating installation angle errors of the first sensor and the third sensor around the second axis based on the detection values acquired in the second detection value acquisition step;

calculating installation angle errors of the first sensor and the second sensor around the third axis based on the detection values acquired in the third detection value acquisition step;

creating the first correction matrix based on the installation angle error of the first sensor around the second axis and the installation angle error of the first sensor around the third axis;

creating the second correction matrix based on the installation angle error of the second sensor around the first axis and the installation angle error of the second sensor around the third axis; and

creating the third correction matrix based on the installation angle error of the third sensor around the first axis and the installation angle error of the third sensor around the second axis.

13. The correction parameter creation method according to claim 11,

wherein the correction parameter creation step includes:

calculating installation angle errors of the second sensor and the third sensor around the first axis based on the detection values acquired in the first detection value acquisition step;

calculating installation angle errors of the first sensor and the third sensor around the second axis based on the detection values acquired in the second detection value acquisition step;

calculating installation angle errors of the first sensor and the second sensor around the third axis based on the detection values acquired in the third detection value acquisition step;

creating the first correction matrix based on the installation angle error of the first sensor around the second axis and the installation angle error of the first sensor around the third axis;

creating the second correction matrix based on the installation angle error of the second sensor around the first axis and the installation angle error of the second sensor around the third axis; and

creating the third correction matrix based on the installation angle error of the third sensor around the first axis and the installation angle error of the third sensor around the second axis.

14. A correction parameter creation device that is used to create correction parameters of a correction expression that corrects detection values of a posture detection device to detection values in an orthogonal coordinate system having a first axis, a second axis, and a third axis that perpendicularly intersect as coordinate axes, the posture detection device including a first sensor, a second sensor, and a third sensor that are mounted so that their detection axes are almost parallel to the first axis, the second axis, and the third axis, respectively, and detect an angular velocity or an acceleration, and detecting a posture of an object based on detection signals from the first sensor, the second sensor, and the third sensor, the correction parameter creation device comprising:

a jig that is formed in a shape of a rectangular parallelepiped, and includes a first side, a second side, and a third side that perpendicularly intersect, the jig being configured so that the posture detection device can be secured on the first side such that the first axis perpendicularly intersects the second side, the second axis perpendicularly intersects the third side, and the third axis perpendicularly intersects the first side;

a turntable having an upper side on which a side of the jig opposite to the first side, the second side, or the third side can be secured; and

a rotation control section that rotates the turntable at a predetermined angular velocity.

15. A posture detection device comprising:

a first sensor, a second sensor, and a third sensor that are mounted so that their detection axes are almost parallel to a first axis, a second axis, and a third axis that perpendicularly intersect, respectively, and detect an angular velocity or an acceleration;

a storage section that stores correction parameters of a correction expression that corrects detection values of the first sensor, the second sensor, and the third sensor to detection values in an orthogonal coordinate system having the first axis, the second axis, and the third axis as coordinate axes;

an A/D conversion section that converts detection signals from the first sensor, the second sensor, and the third sensor into digital signals; and

a correction calculation section that calculates the correction expression based on the digital signals and the correction parameters,

the correction expression including a first correction matrix, a second correction matrix, and a third correction matrix as the correction parameters, the first correction matrix, the second correction matrix, and the third correction matrix correcting the detection values of the first sensor, the second sensor, and the third sensor to the detection values in the orthogonal coordinate system, and being the sum of three matrices obtained by the product of the first correction matrix and a matrix that includes a digital value obtained by A/D-converting the detection value of the first sensor as an element, the product of the second correction matrix and a matrix that includes a digital value obtained by A/D-converting the detection value of the second sensor as an element, and the product of the third correction matrix and a matrix that includes a digital value obtained by A/D-converting the detection value of the third sensor as an element.

16. The posture detection device according to claim 15,

wherein the first correction matrix is an inverse matrix of a rotation matrix that transforms the detection axis of the first sensor into the first axis, the second correction matrix is an inverse matrix of a rotation matrix that transforms the detection axis of the second sensor into the second axis, and the third correction matrix is an inverse matrix of a rotation matrix that transforms the detection axis of the third sensor into the third axis.

17. The posture detection device according to claim 15, further comprising:

a signal selection section that sequentially selects one of the detection signals from the first sensor, the second sensor, and the third sensor in a predetermined cycle,

wherein the A/D conversion section includes an A/D conversion circuit that sequentially A/D-converts the detection signal selected by the signal selection section.

18. The posture detection device according to claim 16, further comprising:

a signal selection section that sequentially selects one of the detection signals from the first sensor, the second sensor, and the third sensor in a predetermined cycle,

wherein the A/D conversion section includes an A/D conversion circuit that sequentially A/D-converts the detection signal selected by the signal selection section.