×

Orientation angle detector

  • US 6,636,826 B1
  • Filed: 06/13/2001
  • Issued: 10/21/2003
  • Est. Priority Date: 12/17/1998
  • Status: Expired due to Fees
First Claim
Patent Images

1. An orientation angle detector comprising:

  • a plurality of gyroscopes (301-303) disposed in parallel with a plurality of orthogonal axes (Xs-Zs) defining a detector co-ordinate on said detector, respectively, for measuring angular velocities (Jx, Jy, Jz) around respective axes (Xs-Zs), a motion angle calculator (310) coupled to said plurality of gyroscopes (301-303) for calculating a motion angle (Δ

    X, Δ

    Y, Δ

    Z) from said angular velocities (Jx, Jy, Jz), at least one accelerometer (403, 404) disposed in parallel with at least one of said orthogonal axes (Xs-Zs) for measuring linear acceleration (Ax, Ay), a static angle calculator (405) coupled to said at least one accelerometer (403, 404) for calculating a static angle (R, P) from said acceleration (Ax, Ay), and an orientation angle calculator (60) coupled to said motion angle calculator (310) and said static angle calculator (405) for integrating said motion angle (Δ

    X, Δ

    Y, Δ

    Z) to an integrated angle and calculating an orientation angle (α

    , β

    , γ

    ) from said integrated angle, said static angle (R, P) and an azimuthal deviation angle (Φ

    ), wherein said orientation angle (α

    , β

    , γ

    ) is an angular difference between said detector co-ordinate (Xs-Ys-Zs) and a reference co-ordinate (X-Y-Z) in a space including said detector, wherein two magnetometers (401, 402) are disposed in parallel with two of said plurality of orthogonal axes (Xs, Ys) to measure terrestrial magnetic components (Mx, My) in the two of said plurality of axes (Xs, Ys), and wherein said static angle calculator (405) is coupled to said two magnetometers (401, 402) for calculating an azimuth from said terrestrial magnetic components (Mx, My) to produce from said azimuth said azimuthal deviation angle (Φ

    ) from said reference co-ordinate (X-Y-Z) as an additional factor of said static angle (R, P).

View all claims
  • 2 Assignments
Timeline View
Assignment View
    ×
    ×