Acceleration error compensated attitude sensing and control apparatus and method

• US 4,038,876 A
• Filed: 03/04/1976
• Issued: 08/02/1977
• Est. Priority Date: 03/04/1976
• Status: Expired due to Term

• Current Assignee: New SD, Inc.
• Original Assignee: Systron Donner Corporation
• Inventors: Morris, Harold D.
• Primary Examiner(s): Woodiel, Donald O.
• Application Number:
  US05/664,059
• Time in Patent Office: 516 Days
• Field of Search: 73/510, 73/432 R, 73/178 R, 73/178 T, 33/328, 235/150.25
• US Class Current: 73/1.38
• CPC Class Codes: G01C 21/18 Stabilised platforms, e.g. by gyroscope
• CPC Class Codes: G05D 1/0875 specially adapted to water vehicles
• CPC Class Codes: Y10S 73/10 instrument mechanisms with acceleration compensation

Abstract

A structural body is monitored in angular position about at least one axis by utilizing a tilt sensor responsive to tilt about the one axis and a sensor responsive to angular acceleration of the body about the one axis. The tilt sensor also responds to the tangential component of angular acceleration and the angular acceleration sensor output contains a component which results from linear acceleration sensitivity along a cross axis of the angular acceleration sensor. The cross axis of the angular accelerameter is aligned with the sensitive axis of the tilt sensor and a portion of the tilt sensor output related to the ratio of the two sensor scale factors is injected into the angular acceleration sensor output to cancel the cross axis sensitivity. A portion of the angular acceleration sensor output related to the distance between the one axis and the mounting position of the tilt sensor is injected into the tilt sensor output to cancel the tangential component of angular acceleration.

Claims

1. An error compensated attitude sensing apparatus comprising

a support structure

an angular accelerometer mounted on said support structure for producing an angular acceleration indicative output, said angular accelerometer having an angular acceleration sensing axis and a linear acceleration sensitive axis oriented orthogonally thereto,

whereby said angular acceleration indicative output may include a linear acceleration sensitivity output component,

a tilt sensor mounted on said support structure for producing an angle of tilt indicative output wherein said angle of tilt is relative to a reference plane,

said tilt sensor having tilt axis and a linear acceleration sensing axis in orthogonal relation, said tilt axis being aligned substantially parallel with said angular acceleration sensing axis and said angular accelerometer linear acceleration sensitive axis being aligned substantially parallel with said linear acceleration sensing axis,

means for receiving said angular acceleration indicative output and for producing an angle indicative output,

means for receiving said angle indicative output and said angle of tilt indicative output and producing a combined angle indicative output,

and means for coupling said angle of tilt indicative output to said angular acceleration indicative output in predetermined proportion so that said linear acceleration sensitivity output component therein is substantially cancelled.

2. An error compensated attitude sensing apparatus as in claim 1 wherein said support structure has a center of rotation and said tilt sensor is mounted a predetermined distance therefrom, together with means for connecting a predetermined portion of said angular accereration indicative output to said angle of tilt indicative output, said predetermined portion being dependent upon said predetermined distance,

whereby tangential acceleration sensed by said angle of tilt sensor due to angular acceleration about the center of rotation is compensated.

3. An error compensated attitude sensing apparatus as in claim 1 wherein said support structure is a platform together with a framework,

means attached to said platform for mounting said platform on said framework for rotational movement relative thereto, and an additional angular accelerometer mounted on said framework for producing an additional angular acceleration indicative output, said framework having a center of rotation with said tilt sensor mounted a predetermined distance therefrom, means for coupling a predetermined portion of said additional angular acceleration indicative output to said angle of tilt indicative output, said predetermined portion being dependent upon said predetermined distance, so that signal related to tangential acceleration in said angle of tilt indicative output due to angular acceleration of said framework are substantially cancelled.

4. An error compensated attitude sensing apparatus comprising a framework,

an angular accelerometer mounted on said framework providing an angular acceleration indicative output,

a tilt sensor mounted in said framework providing an angle of tilt indicative output, said angle of tilt being relative to a reference plane,

said tilt sensor having a tilt axis and a linear acceleration sensing axis in orthogonal relation, said tilt axis being aligned substantially parallel with said angular acceleration sensing axis,

means for receiving and converting said angular acceleration indicative output to an angle indicative output,

means for receiving said angle indicative output and said angle of tilt indicative output and providing a combined angle indicative output,

said last named output being connected to the input of said means for receiving and converting so that transients and drift in said angle indicative output are compensated,

said framework having a center of rotation and said tilt sensor being mounted a predetermined distance therefrom,

means for connecting a predetermined portion of said angular acceleration indicative output to said angle of tilt indicative output, said predetermined portion being dependent upon said predetermined distance,

whereby signal components in said angle of tilt indicative output due to tangential acceleration of said tilt sensor are compensated.

5. An error compensated attitude sensing apparatus comprising a supporting structure,

an angular accelerometer mounted on said supporting structure for providing an angular acceleration indicative output, said angular accelerometer having an acceleration sensing axis and a cross axis orthogonal thereto which is linear acceleration sensitive, whereby in the presence of linear acceleration said angular acceleration indicative output includes a cross axis sensitivity output component,

a tilt sensor mounted on said support structure providing an angle of tilt indicative output which is relative to a reference plane,

said tilt sensor having a tilt axis and a linear acceleration sensing axis oriented orthogonal thereto,

said tilt axis being aligned substantially parallel with said angular acceleration sensing axis and said cross axis being aligned substantially parallel with said linear acceleration sensing axis,

and means for coupling said angle of tilt indicative output to said angular acceleration indicative output in predetermined proportion to substantially cancel said cross axis sensitivity component.

6. An error compensated attitude sensing apparatus as in claim 5 wherein said support structure is floating and has a center of rotation and said tilt sensor is mounted a predetermined distance therefrom, together with means for coupling said angular acceleration indicative output to said angle of tilt indicative output in proportion to said predetermined distance,

whereby indicative of tangential acceleration due to angular acceleration about said center of rotation are substantially cancelled from said angle of tilt indicative output.

7. An error compensated attitude sensing apparatus as in claim 5 together with a framework and means for locating said supporting structure in rotational relation with said framework.

8. An error compensated attitude sensing apparatus as in claim 7 together with an additional angular accelerometer mounted on said framework providing an additional angular acceleration indicative output related to the angular acceleration of said framework, said framework having a center of rotation with said tilt sensor mounted a predetermined distance therefrom, means for coupling a predetermined portion of said additional angular acceleration indicative output to said angle of tilt indicative output said predetermined portion being related to said predetermined distance,

so that signal components in said angle of tilt indicative output due to tangential acceleration resulting from angular acceleration of said framework are cancelled.

9. An error compensated attitude sensing apparatus as in claim 6 wherein said means for coupling comprises means for receiving and converting said angular acceleration indicative output to an angle indicative output having a scale factor which is matched with said angle of tilt indicative output, said means for receiving and converting having fast response relative to said means for coupling said angle of tilt indicative output so that transient outputs in said tilt indicative output which appear in said angle indicative output are reduced.

10. An error compensated attitude sensing apparatus comprising a support structure,

a tilt sensor mounted on said support structure providing an angle of tilt indicative output referenced to a predetermined plane, said tilt sensor having a tilt axis, and a linear acceleration sensing axis oriented orthogonally thereto,

an angular accelerometer mounted on said support structure providing an angular acceleration indicative output, said angular accelerometer having an angular acceleration sensing axis and a linear acceleration sensitive axis oriented orthogonally thereto, so that in the presence of linear acceleration said angular acceleration indicative output contains a linear acceleration sensitive component, said tilt axis being aligned substantially parallel to said angular acceleration sensing axis and said linear acceleration sensitive axis being aligned substantially parallel to said angular accelerometer linear acceleration sensitive axis,

means for receiving and converting said angular acceleration indicative output to an angle indicative output, means for coupling said angle of tilt indicative output to said angle indicative output, said angle of tilt indicative output having a scale factor similar to said angle indicative output whereby a combined angle indicative output is provided, said means for receiving and converting having fast response relative to said means for coupling said angle of tilt indicative output, whereby transient outputs in said angle of tilt indicative output are substantially eliminated from said combined angle indicative output, said support structure having a center of rotation and said tilt sensor being mounted a predetermined distance therefrom, together with means for coupling a predetermined portion of said angular acccleration indicative output to said angle of tilt indicative output, said predetermined portion being related to said predetermined distance, so that error signal produced by tangential acceleration sensed by said tilt sensor and appearing in said angle of tilt indicative output is substantially cancelled.

11. An error compensated attitude sensing apparatus comprising a support structure,

a tilt sensor mounted on said support structure providing an angle of tilt indicative output referenced to a predetermined plane, said tilt sensor having a tilt axis, and a linear acceleration sensing axis oriented orthogonally thereto,

an angular accelerometer mounted on said support structure providing an angular acceleration indicative output, said angular accelerometer having an angular acceleration sensing axis and a linear acceleration sensitive axis oriented orthogonally thereto, so that in the presence of linear acceleration said angular acceleration indicative output contains a linear acceleration sensitive component, said tilt axis being aligned substantially parallel to said angular acceleration sensing axis and said linear acceleration sensitive axis being aligned substantially parallel to said angular accelerometer linear acceleration sensitive axis,

means for receiving and converting said angular acceleration indicative output to an angle indicative output, means for coupling said angle of tilt indicative output to said angle indicative output, said angle of tilt indicative output having a scale factor similar to said angle indicative output whereby a combined angle indicative output is provided, said means for receiving and converting having fast response relative to said means for coupling said angle of tilt indicative output,

whereby transient outputs in said angle of tilt indicative output are substantially eliminated from said combined angle indicative output, said support structure including a platform together with a framework, means for supporting said support structure in said framework for rotational motion therewith,

and an additional angular accelerometer mounted on said framework providing an additional angular acceleration indicative output related to the angular acceleration thereof,

said framework having a center of rotation with said tilt sensor mounted a predetermined distance therefrom,

12. means for coupling a predetermined portion of said additional angular acceleration indicative output to said angle of tilt indicative output, said predetermined portion depending on said predetermined distance, so that components in said angle indicative output due to tangential acceleration of said tilt sensor are substantially removed.

13. An error compensated attitude sensing apparatus comprising a support structure,

an angular accelerometer mounted on said support structure providing an angular acceleration indicative output, said angular accelerometer having an angular acceleration sensing axis and a linear acceleration sensitive axis oriented orthogonal thereto, said angular acceleration indicative output thereby having a linear acceleration sensitive output component included in the presence of linear acceleration,

a tilt sensor mounted on said support structure providing an angle of tilt indicative output related to a reference plane,

said tilt sensor having a tilt axis and a linear acceleration sensitive axis is orthogonal relation, said tilt axis being aligned substantially parallel with said angular acceleration sensing axis and said linear acceleration sensing axis being aligned substantially parallel with said angular accelerometer linear acceleration sensitive axis,

means for coupling a predetermined portion of said angle of tilt indicative output to said angular acceleration indicative output so that said linear acceleration sensitivity output component is substantially cancelled,

means for passing low frequency angle of tilt indicative output,

means for passing high frequency angular acceleration indicative output,

means for combining said high and low frequency outputs providing an angle output,

a platform mounted on said support structure for rotational movement therewith about at least one axis,

means mounted on said one axis for urging said platform rotationally toward a rotational position responsive to said angle output.

15. The method of sensing as in claim 13 wherein said linear acceleration indicative signal contains a component resulting from tangential acceleration occurring as a result of the angular acceleration of the framework and the radius between the linear acceleration sensor and the axis of rotation of the framework,

together with the step of cancelling the tangential acceleration component with a portion of the angular acceleration indicative signal related to the radius of rotation.

17. An error compensated acceleration sensor as in claim 15 wherein the body has an axis of rotation and said linear accelerometer is mounted a predetermined distance from said axis of rotation, whereby said linear acceleration indicative output contains a component corresponding to tangential acceleration of said linear accelerometer resulting when the body is accelerated about said axis or rotation, and means for coupling a signal portion of said angular acceleration indicative output to said linear acceleration indicative output, said signal portion being determined by said predetermined distance and the ratio of linear acceleration indicative output scale factor to angular acceleration indicative output scale factor, whereby error in said linear acceleration indicative output due to tangential acceleration of the body is reduced.

18. An error compensated acceleration sensor as in claim 15 wherein the body has an axis of rotation and said linear accelerometer is mounted a predetermined distance from said axis of rotation with said linear acceleration sensing axis being aligned substantially with the direction from said axis of rotation to said linear accelerometer, whereby said linear acceleration indicative output contains a component corresponding to radial acceleration of said linear accelerometer resulting when the body is moving at an angular velocity about said axis of rotation, means for providing an angular velocity indicative output, and means for coupling a signal portion of said angular velocity indicative output to said linear acceleration indicative output, said signal portion being determined by said predetermined distance and the square of said angular velocity indicative output, whereby error in said linear acceleration indicative output due to radial acceleration of the body is reduced.

19. An error compensated acceleration sensor as in claim 17 wherein said means for providing an angular velocity indicative output is an integrator coupled to receive said angular acceleration indicative output.

14. The method of sensing the attitude of a framework and compensating the attitude sensing apparatus for spurious sensing signals comprising the steps of

obtaining an angular acceleration indicative signal containing a spurious linear acceleration signal component therein of known scale factor,

obtaining a linear acceleration indicative signal having a sense opposed to said spurious linear acceleration signal component, and cancelling the spurious linear acceleration signal component by injecting into the angular acceleration indicative signal a portion of the linear acceleration indicative signal related to the ratio of the signal scale factors.

16. An error compensated acceleration sensor for mounting on a body to be acceleration monitored, comprising

an angular accelerometer mounted on the body providing an angular acceleration indicative output, said angular accelerometer having an angular acceleration sensing axis and a linear acceleration sensitive axis, said angular acceleration indicative output thereby containing an error component when the body is subjected to linear acceleration having a component colinear with said linear acceleration sensitive axis, a linear accelerometer mounted on the body providing a linear acceleration indicative output and having a linear acceleration sensing axis, said linear acceleration sensing axis being aligned substantially parallel to said linear acceleration sensitive axis,

and means for coupling a portion of said linear acceleration indicative output to said angular acceleration indicative output for reducing said error component.

20. An error compensated acceleration sensor for mounting on a body to be acceleration monitored, the body having an axis of rotation, comprising

an angular accelerometer mounted on the body providing an angular acceleration output, said angular accelerometer having an angular acceleration sensing axis,

a linear accelerometer mounted on the body providing a linear acceleration sensitive output and having a linear acceleration sensitive axis, said linear accelerometer being mounted a predetermined distance from the axis or rotation,

whereby said linear acceleration indicative output contains a component corresponding to tangential acceleration of said linear accelerometer when the body is accelerated about the axis of rotation,

and means for coupling a signal portion of said angular acceleration indicative output to said linear acceleration indicative output, said signal portion being determined by said predetermined distance and the ratio of linear acceleration indicative output scale factor to angular acceleration indicative output scale factor, whereby error in said linear acceleration indicative output due to tangential acceleration of the body is reduced.

22. An error compensated acceleration sensor as in claim 20 together with an angular accelerometer providing an angular acceleration indicative output and having an sensitive axis aligned in substantially parallel relation with the axis of rotation, said means for providing an angular velocity indicative output comprising an integrator for receiving said angular acceleration indicative output.

24. An error compensated acceleration apparatus as in claim 22 wherein said angular accelerometer has an angular acceleration sensing axis and a linear acceleration sensitive axis oriented orthogonally thereto, whereby said angular acceleration indicative output includes a linear acceleration sensitivity output component in the presence of linear acceleration, said angular accelerometer linear acceleration sensitive axis being aligned substantially parallel with said tilt sensor linear acceleration sensing axis,

and means for coupling said angle of tilt indicative output to said angular acceleration indicative output in predetermined proportion, so that said linear acceleration sensitivity output component is substantially reduced.

25. An error compensated accelerated apparatus as in claim 22 together with means of coupling a predetermined portion of said angular acceleration indicative output to said angle of tilt indicative output, said predetermined portion being dependent upon said predetermined distance, whereby tangential acceleration sensed by said angle of tilt sensor due to angular acceleration about the center of rotation is compensated.

21. An error compensated acceleration sensor for mounting on a body to be acceleration monitored, the body having an axis of rotation, comprising

a linear accelerometer mounted on the body providing a linear acceleration sensitive output therefrom and having a linear acceleration sensitive axis, said linear accelerometer having a mount desposed a predetermined distance from the axis of rotation, said linear acceleration sensitive axis being in substantial alignment with the direction between said axis of rotation and said mount, whereby said linear acceleration sensitive output contains a component corresponding to radial acceleration of said mount when the body is moving at an angular velocity about the axis of rotation, means for providing an output indicative of the angular velocity of the body,

said signal portion being determined by said predetermined distance and the square of said angular velocity indicative output, whereby error in said linear acceleration indicative output due to radial acceleration of the body is reduced.

23. An error compensated attitude sensing apparatus comprising

a support structure havng a center of rotation

an angular accelerometer mounted on said support structure for producing an angular acceleration indicative output,

a tilt sensor mounted on said support structure a predetermined distance from said center of rotation for producing an angle of tilt indicative output wherein said angle of tilt is relative to a reference plane,

said tilt sensor having a tilt axis and a linear acceleration sensing axis in orthogonal relation, said tilt axis being aligned substantially parallel with said angular acceleration sensing axis and said linear acceleration sensing axis having a component aligned along the direction between said tilt sensor and said center of rotation, whereby said angle of tilt indicative output contains a component corresponding to radial acceleration when said support structure is moving at an angular velocity about said center of rotation,

means for receiving said angular acceleration indicative output and for producing an angular velocity indicative output and an angle indicative output,

means for receiving said angle indicative output and said angle of tilt indicative output and producing a combined angle indicative output,

and means for coupling a signal portion of said angular velocity indicative output to said tilt indicative output, said signal portion being determined by said predetermined distacne and the square of said angular velocity indicative output, whereby error in said tilt indicative output due to radial acceleration of said support structure is reduced.