The present invention generally relates to the use of accelerometers for inertial measurement, and more particularly, to a five degree of freedom inertial measurement unit in which an arrangement of accelerometer sensors is used to measure linear and angular acceleration.
Many types of hand held devices, such as remote controls, mobile phones, games, and cameras, benefit from knowing their orientation in space. Since portable devices can be held in almost any orientation, one would ideally need a six degree of freedom inertial measurement unit. As known in the art, a six degree of freedom inertial measurement unit provides data relating to 1) linear acceleration along three orthogonal axes (i.e., the X-axis, Y-axis, and Z-axis), and 2) rotational movement about those three axes (i.e., the pitch, roll, and yaw axes).
However, as a practical matter, such devices are normally operated such that only a five degrees of freedom inertial measurement unit is required. For example, while roll rate and yaw rate measurements may be of interest for an automobile, pitch rate is typically ignored. Various remote controls such as television remote controls, may require pitch rate and yaw rate for proper operation, but not roll rate.
Five degree of freedom inertial measurement units are typically are made by combining a plurality of linear accelerometer sensors with angular rate sensors (e.g., gyroscopes). For example, a conventional five degree of freedom accelerometer may include acceleration sensors for measuring linear acceleration along the three orthogonal axes, and additionally, two angular rate sensors for measuring rotation about two of those axes.
In accordance with one aspect of the invention, a five degree of freedom inertial measurement unit is capable of measuring 1) linear acceleration of a body along a first axis, a second axis, and a third axis, 2) angular acceleration of the body about the second axis, and 3) angular acceleration about the third axis. The first axis, the second axis, and third axis are substantially mutually orthogonal and intersect at an origin point. To that end, the unit includes first and second accelerometers that are in fixed positions relative to the body. The first and second accelerometers each measure linear acceleration along both the second axis and the third axis. The first and second accelerometers are positioned on a plane defined by the first axis and the second axis. A controller, which is operatively coupled to the first accelerometer and the second accelerometer, determines the angular acceleration of the body about the second axis, and the angular acceleration of the body about the third axis. To that end, the controller uses no other acceleration signals other than the linear acceleration signals from the first and second accelerometers.
In related embodiments of the invention, the controller may include a first integrator for integrating the angular acceleration to obtain angular velocity. A second integrator may integrate the angular velocity to obtain angular position. Both the first accelerometer and second accelerometer may be fixed to the body such that they measure positive linear acceleration along the second axis in opposing directions. The controller may include a circuit operatively coupling first and second accelerometer outputs associated with the second axis, so as to output an angular acceleration signal proportional to the angular acceleration of the body across the second axis. The circuit may include a high pass filter for filtering the angular acceleration output. The circuit may include a first integration element for integrating the angular acceleration signal so as to output an angular velocity signal indicative of the angular velocity of the body across the second axis. The circuit may include a second integration element for integrating the angular velocity output so as to output an angular position signal indicative of the angular position of the body relative to the second axis.
In accordance with another aspect of the invention, a method is presented for measuring 1) linear acceleration of a body along a first axis, a second axis, and a third axis, 2) angular acceleration of the body about the second axis, and 3) angular acceleration of the body about the third axis. The first axis, the second axis, and third axis are substantially mutually orthogonal and intersect at an origin point. The method includes positioning first and second accelerometers in fixed positions relative to the body. The first and second accelerometers each measure linear acceleration along both the second axis and the third axis. The first and second accelerometers are positioned on a plane defined by the first axis and the second axis. An angular acceleration of the body is determined about the second axis, and an angular acceleration is determined about the third axis, using no other acceleration signals other than the linear acceleration signals from the first and second accelerometers.
In accordance with related embodiments of the invention, positioning the first accelerometer and the second accelerometer may include fixing the first and second accelerometers to the body such that they measure positive linear acceleration along the second axis in opposing directions. Angular acceleration of at least one of the first axis and second axis may be integrated to obtain an angular velocity of the body across the at least one of the first axis and the second axis. The angular velocity may be further integrated across the at least one of the first axis and the second axis to obtain an angular position of the body across the at least one of the first axis and the second axis.
In accordance with still another aspect of the invention, a five degree of freedom inertial measurement unit is capable of measuring 1) linear acceleration of a body along a first axis, a second axis, and a third axis, 2) angular acceleration of the body about the second axis, and 3) angular acceleration of the body about the third axis. The first axis, the second axis, and third axis are substantially mutually orthogonal and intersect at an origin point. The unit includes first and second accelerometers that are in fixed positions relative to the body. The first and second accelerometers each measure linear acceleration along both the second axis and the third axis. The first and second accelerometers are positioned on a plane defined by the first axis and the second axis. The unit further includes a means for determining an angular acceleration of the body about the second axis, and an angular acceleration of the body about the third axis,. To that end, the determining means uses no other acceleration signals other than the linear acceleration signals from the first and second accelerometers.
In related embodiments of the invention, the means for determining may include a first integrator for integrating the angular acceleration to obtain angular velocity. A second integrator may integrate the angular velocity to obtain angular position. Both the first accelerometer and second accelerometer may be fixed to the body such that they measure positive linear acceleration along the second axis in opposing directions. The means for controlling may include a circuit operatively coupling first and second accelerometer outputs associated with the second axis, so as to output an angular acceleration signal proportional to the angular acceleration of the body across the second axis. The circuit may include a high pass filter for filtering the angular acceleration output. The circuit may include a first integration element for integrating the angular acceleration signal so as to output an angular velocity signal indicative of the angular velocity of the body across the second axis. The circuit may include a second integration element for integrating the angular velocity output so as to output an angular position signal indicative of the angular position of the body relative to the second axis.
In some embodiments, at least one of the first accelerometer and the second accelerometer may be a tri-axial accelerometer, the tri-axial accelerometer measuring linear acceleration along the first, second and third axis. No other acceleration signals other than the linear acceleration signals from the first and second accelerometers are used in determining 1) linear acceleration of the body along the first axis, the second axis, and the third axis, 2) angular acceleration of the body about the second axis, and 3) angular acceleration of the body about the third axis.
In still other embodiments, a third accelerometer may measure linear acceleration along the first axis. No other acceleration signals other than the linear acceleration signals from the first, second and third accelerometers are used in determining 1) linear acceleration of the body along the first axis, the second axis, and the third axis, 2) angular acceleration of the body about the second axis, and 3) angular acceleration of the body about the third axis.
The foregoing features of the invention will be more readily understood by reference to the following detailed description, taken with reference to the accompanying drawings, in which:
In illustrative embodiments, a five degree of freedom inertial measurement unit uses a minimal number of linear accelerometers to determine both linear and angular acceleration. Thus, the unit requires no angular rate sensors. Furthermore, the unit has an efficient circuit that uses linear accelerometers to obtain angular acceleration, angular rate and/or angular position. Details are discussed below.
The first accelerometer 102 is fixed to a body 106 and measures linear acceleration along three axes X1, Y1 and Z1 that are parallel to the X-axis 110, Y-axis 112 and Z-axis 114, respectively. In a corresponding manner, the second accelerometer 104 also is fixed to the body 106 and measures linear acceleration along three axes X2, Y2 and Z2, that are parallel to the X-axis 110, Y-axis 112 and Z-axis 114, respectively. The first and second accelerometers 102 and 104 are positioned to be a specified distance apart from each other and furthermore, are positioned on a plane defined by the X-axis 110 and the Y-axis 112.
A controller 130 operatively coupled with the two accelerometers 102 and 104 determines the angular acceleration of the body about the Y and Z axes 112 and 114, and linear acceleration along the X, Y and Z axes 110, 112, and 114. In illustrative embodiments, the controller determines these values by using no other acceleration signals other than the linear acceleration signals from the first and second accelerometers 102 and 104. The controller 130 may integrate the angular acceleration to determine angular rate (i.e., angular velocity). Furthermore, the controller 130 may integrate the angular rate to determine angular position.
The controller 130, which is shown in greater detail in
The controller 130 may determine acceleration in a number of ways. For example, the angular acceleration about the Z-axis (referred to herein as yaw) is proportional to (Y1-Y2)*(dY1-Y2): where 1) Y1 is the acceleration measured by the first accelerometer 102 along the Y-axis, 2) Y2 is the acceleration measured by the second accelerometer 104 along the Y-axis, and 3) dY1-Y2 is the distance between the accelerometers 102 and 104 that measure the acceleration along the Y-axis.
To assist in deriving yaw,
y(t)=r*SIN ωt (1)
y′(t)=r*ω*COS ωt (2)
y″(t)=−r*ω2*SIN ωt(3)
Returning back to
Yaw acceleration=4*π2*f2*dY1-Y2*SIN θ (4)
Pitch acceleration=4*π2*f2*dZ1-Z2*SIN θ (5)
Angular rate is the integral of the above:
Yaw rate=4*dY1-Y2*π*f*COS(2*π*f) (6)
Pitch rate=b 4*dZ1-Z2*π*f*COS(2*π*f) (7)
As can be seen from the formulas above, the distance (d) can be varied to suit the application. For example, if small angular rates must be measured, d can be increased to improve sensitivity. If d is reduced to zero, there is no sensitivity to angular rate.
In a similar manner, the angular acceleration about the Y-axis (referred to herein as pitch) is proportional to (Z1-Z2)*(dZ1-Z2), where: 1) Z1 is the acceleration measured by the first accelerometer 102 along the Z-axis, 2) Z2 is the acceleration measured by the second accelerometer 104 along the Z-axis, and 3) dZ1-Z2 is the distance between the accelerometers 102 and 104 that measure the acceleration along the Z-axis.
Note that the Y-axis can be moved along the X-axis without changing the above derived yaw or pitch. Similarly, the Z-axis may be moved along the X-axis without changing the derived signals.
By using two accelerometers, the subtraction of (Y1-Y2) in calculating yaw advantageously rejects translational motion along the Y-axis, leaving only angular acceleration across the Y-axis. Similarly, the subtraction of (Z1-Z2) in calculating pitch rejects translational motion along the Z-axis, leaving only angular acceleration across the Z-axis.
Alternative embodiments may use other accelerometer configurations. For example,
Illustrative embodiments of the invention simplify accelerometer signal conditioning by mounting the accelerometers such that certain measurement directions oppose each other. For example, with regard to
The units shown in
Additional circuitry may include a buffer 504, and/or a high pass filter 505 to exclude DC response. The circuit may also include an output gain/buffer stage 506.
The accelerometers in the above-described embodiments may be of various types known in the art. For example, the accelerometers may be a multi-axis capacitive sensor of the type described in U.S. Pat. No. 5,939,633, which is hereby incorporated by reference in its entirety. An exemplary three-axis accelerometer is distributed by Analog Devices, Inc. of Norwood, Mass. and is described generally in the ADXL330 Three-axis Accelerometer data sheet, which is hereby incorporated herein by reference in its entirety. An exemplary two-axis accelerometer, also distributed by Analog Devices, Inc., is described generally in the ADXL322 Dual-axis Accelerometer data sheet, which is hereby incorporated herein by reference in its entirety.
The present invention may be embodied in many different forms, including, but in no way limited to, computer program logic for use with a processor (e.g., a microprocessor, microcontroller, digital signal processor, or general purpose computer), programmable logic for use with a programmable logic device (e.g., a Field Programmable Gate Array (FPGA) or other PLD), discrete components, integrated circuitry (e.g., an Application Specific Integrated Circuit (ASIC)), or any other means including any combination thereof.
Computer program logic implementing all or part of the functionality previously described herein may be embodied in various forms, including, but in no way limited to, a source code form, a computer exec structure form, and various intermediate forms (e.g., forms generated by an assembler, compiler, linker, or locator.) Source code may include a series of computer program instructions implemented in any of various programming languages (e.g., an object code, an assembly language, or a high-level language such as FORTRAN, C, C++, JAVA, or HTML) for use with various operating systems or operating environments. The source code may define and use various data structures and communication messages. The source code may be in a computer execustructure form (e.g., via an interpreter), or the source code may be converted (e.g., via a translator, assembler, or compiler) into a computer executable structure form.
The computer program may be fixed in any form (e.g., source code form, computer execustructure form, or an intermediate form) either permanently or transitorily in a tangible storage medium, such as a semiconductor memory device (e.g., a RAM, ROM, PROM, EEPROM, or Flash-Programmable RAM), a magnetic memory device (e.g., a diskette or fixed disk), an optical memory device (e.g., a CD-ROM), a PC card (e.g., PCMCIA card), or other memory device. The computer program may be fixed in any form in a signal that is transmittable to a computer using any of various communication technologies, including, but in no way limited to, analog technologies, digital technologies, optical technologies, wireless technologies, networking technologies, and internetworking technologies. The computer program may be distributed in any form as a removable storage medium with accompanying printed or electronic documentation (e.g., shrink wrapped software or a magnetic tape), preloaded with a computer system (e.g., on system ROM or fixed disk), or distributed from a server or electronic bulletin board over the communication system (e.g., the Internet or World Wide Web.)
Hardware logic (including programmable logic for use with a programmable logic device) implementing all or part of the functionality previously described herein may be designed using traditional manual methods, or may be designed, captured, simulated, or documented electronically using various tools, such as Computer Aided Design (CAD), a hardware description language (e.g., VHDL or AHDL), or a PLD programming language (e.g., PALASM, ABEL, or CUPL).
Although the above discussion discloses various exemplary embodiments of the invention, it should be apparent that those skilled in the art can make various modifications that will achieve some of the advantages of the invention without departing from the true scope of the invention. Other variations and modifications of the embodiments described above are intended to be within the scope of the present invention as defined in the appended claims.
The present application claims priority from U.S. Provisional patent application Ser. No. 60/643,530, entitled “Five Degree of Freedom Inertial Measurement Device,” filed Jan. 13, 2005, the contents of which are incorporated herein by reference.
Number | Date | Country | |
---|---|---|---|
60643530 | Jan 2005 | US |