US6128955A - Method for measuring 6 degrees of freedom motion and device therefor - Google Patents

Method for measuring 6 degrees of freedom motion and device therefor Download PDF

Info

Publication number
US6128955A
US6128955A US09/349,598 US34959899A US6128955A US 6128955 A US6128955 A US 6128955A US 34959899 A US34959899 A US 34959899A US 6128955 A US6128955 A US 6128955A
Authority
US
United States
Prior art keywords
axis
rigid body
directional
uni
accelerometers
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
US09/349,598
Inventor
Nobuharu Mimura
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Individual
Original Assignee
Individual
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Individual filed Critical Individual
Priority to US09/349,598 priority Critical patent/US6128955A/en
Application granted granted Critical
Publication of US6128955A publication Critical patent/US6128955A/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/166—Mechanical, construction or arrangement details of inertial navigation systems
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
    • G01C21/188—Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
    • G01P15/18—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration in two or more dimensions

Definitions

  • the present invention relates to a method for measuring a 6 degrees of freedom (DOF) motion of a rigid body such as vehicle, and a device therefor.
  • DOF degrees of freedom
  • a three-axis linear accelerometer and a three-axis mechanical rate gyroscope have been recognized as measurement devices for measurement of 6 degrees of freedom (DOF) motion of a rigid body such as vehicle.
  • DOF degrees of freedom
  • the center of rotational motion is not constant, and acceleration signals to be detected by the linear accelerometer involve not only linear acceleration but also centrifugal and angular effects, which, therefore, must be separated therefrom.
  • a conventional rate gyroscope Whilst angular velocity data or angular acceleration data are necessary for such separation, a conventional rate gyroscope has such a low response characteristic that a measurable range has been limited to a motion of low speed, and its phase characteristics also is different from that of linear accelerometer, so that it has a drawback that it is not suitable for separation of signals.
  • a device which comprises: first and second radial magnetic bearings and a pair of thrust magnetic bearings, said bearings holding in place a rotational body which rotates around the X axis; a detector for detecting the number of rotation of the rotational body; and five displacement-detectors for detecting the displacement of the rotational body, said displacement being defined in the directions of the Y, Z axes and the thrust, respectively, whereby the displacement acceleration and displacement angular acceleration of the rotational body are calculated and output, while correcting the displacement in the radial and thrust directions of the rotational body.
  • the conventional six-axis accelerometers have been structured without the sufficient analyses of the relationships of the acceleration and angular acceleration relative to an inertia body, even under the condition where the Coriolis force and centrifugal effects are developed structurally. Therefore, although they would work well relative to an inertia body moving on a two-dimensional plane, they, in a three-dimensional space, are unable to completely remove the effects of the Coriolis force and centrifugal forces which interfere complexly in the direction of each axis, or otherwise, they allow the output signals to be dispersed, and thus there is a likelihood that no stable measurement is able to be performed.
  • an object of the present invention to provide a method for measuring 6 DOF motion, which enables the accurate measurement of a motion of a rigid body, using the least possible accelerometers that are simply disposed.
  • a method for measuring a 6 DOF motion of a rigid body which comprises the steps of: fixing at least six one-axis uni-directional accelerometers to three or more different positions on the same plane as that of a rigid body; and then carrying out processing, using acceleration signals output from each of the one-axis uni-directional accelerometers so that the effects of centrifugal acceleration and rotational angular acceleration included in each one-axis uni-directional accelerometer may be separated therefrom.
  • a device for measuring a 6 DOF motion of a rigid body which comprises: at least six one-axis unidirectional accelerometers fixed to three or more different positions on the same plane as that of a rigid body; and a processing unit for carrying out processing, using acceleration signals output from each of the one-axis uni-directional accelerometers so that the effects of centrifugal acceleration and rotational angular acceleration included in each one-axis uni-directional accelerometer may be separated therefrom.
  • FIG. 1 is a plan view showing a device in accordance with an embodiment of the invention, particularly illustrating a detector body thereof.
  • FIG. 2 is a front view showing a main part of the detector body as shown in FIG. 1.
  • FIG. 3 is a block diagram showing an electrical structure of the device as shown in FIG. 1.
  • FIG. 4 is a schematic explanatory diagram illustrating a case where a single accelerometer is disposed on a rigid body.
  • FIG. 5 is a schematic explanatory diagram illustrating a case where several accelerometers are disposed on a desirable position on a rigid body.
  • FIG. 6 is a graph showing the frequency-acceleration output gain characteristics of a one-axis uni-directional accelerometer of the invention.
  • FIG. 7 is a graph showing the linear acceleration characteristics comparing between a conventional measurement device and a measurement device according to the invention.
  • FIG. 8 is a graph showing the angular velocity characteristics comparing between a conventional measurement device and a measurement device according to the invention.
  • FIG. 9 is a graph showing the power spectrum density characteristics of linear acceleration comparing between a conventional measurement device and a measurement device according to the invention.
  • FIG. 10 is a graph showing the power spectrum density characteristics of angular velocity comparing between a conventional measurement device and a measurement device according to the invention.
  • Reference numeral 11 designates a detecting body whose outer shell is constructed of a flat base 12 and a casing 13 for covering the upper surface of the base 12, said casing 13 being made of transparent resin material, for example.
  • On the base 12 are vertically provided several linkage bars 14. From the upper surface of the casing 13 are inserted screws 15 into the upper ends of the linkage bars 14, thus fixing the base 12 to the casing 13. Whilst the base 12 and the casing 13 are each hexagon-shaped in plan view, their configurations should not be limited to the same.
  • the detector body 11 is mounted to an optional rigid body in motion, such as a moving vehicle,
  • Reference numerals 1 through 6 each designate a strain-gauge type or a capacitance type one-axis uni-directional accelerometer.
  • the number of such one-axis unidirectional accelerometers is six, which is the minimal number to enable the accurate measuring of acceleration in terms of the X, Y and Z axes, and angular acceleration.
  • These one-axis uni-directional accelerometers 1 through 6 each comprise a sensor and various types of signal conditioners formed on the same silicone tip, employing the uniform frequency response characteristic and phase characteristic.
  • Each of the one-axis uni-directional accelerometers 1 through 6 is mounted onto a substrate 16 by soldering.
  • Such one-axis uni-directional accelerometers 1 through 6 being basically structured by a silicone tip, enables the small-sizing of a measurement device. Further, as a signal processing circuit such as an amplifier, is integrated therewith, it is advantageous in that the structure of a hereinbelow-described processing unit 21 can be simplified.
  • the base 12 is fixedly mounted to an object to be measured, i.e., a rigid body (not shown). In other words, the one-axis uni-directional accelerometers 1 through 6 are moved together with a rigid body when a force from external is applied to the rigid body, and thus, no Coriolis force is developed structurally. This is another advantage which conventional 6 DOF motion measurement devices do not have.
  • the one-axis uni-directional accelerometers 1, 3 and 5 are provided so that the respective sensing directions may coincide with the direction of the Z axis, which is orthogonal to the flat base 12.
  • the remaining accelerometers 2, 4 and 6 are provided so that the respective sensing directions may coincide with any arbitrary directions parallel to the X-Y plane which is orthogonal to the said Z axis.
  • a first group consisting of the one-axis uni-directional accelerometers 1, 3 and 5 has a sensing direction directed to the Z axis
  • a second group consisting of the one-axis uni-directional accelerometers 2, 4 and 6 has a sensing direction directed to respective directions which are parallel to the X-Y plane.
  • each substrate 16 for the accelerometers 1, 3 and 5 and the base 12 is provided an adjustment member 17 which allows respective heights of the one-asis uni-directional accelerometers 1, 3 and 5 to align to be the centers of the remaining accelerometers 2, 4 and 6.
  • the adjustment member 17 is an optional one, it is desirable because it allows an initial point of each sensing direction of the one-axis uni-directional accelerometers 1, 3 and 5 to align with each sensing direction of the accelerometers 2, 4 and 6, so that the subsequent processing is simplified.
  • L-shaped angle members 18, each having a vertical face are disposed on the base 12 disposed L-shaped angle members 18, each having a vertical face.
  • the one-axis uni-directional accelerometers 1 and 2 which construct a first detector portion 7 are provided integrally in approximately the same position, being close to each other.
  • the accelerometers 3 and 4 which construct a second detector portion 8, and the accelerometers 5 and 6 which construct a third detector portion 9, are also provided integrally in approximately the same positions, being close to each other, respectively.
  • the first detector portion 7, the second detector portion 8 and the third detector portion 9 are each disposed in different positions on the base 12.
  • the six one-axis uni-directional accelerometers 1 through 6 may be disposed on any arbitrary positions on the same plane, they must be positioned in at least three different positions on the same, the reason for which will be explained in a paragraph relating to a hereinafter-described measurement principle.
  • reference numeral 19 designates a level regulator, having several variable resistances.
  • This level regulator 19 serves to suitably regulate the levels of output signals from each of the one-axis uni-directional accelerometers 1 through 6, but it is not always necessary to provide the same inside the detector body 11.
  • the casing 13 opposite to the level regulator 19 may be provided with an aperture in order that the regulation by the level regulator 19 may be carried out without opening or closing the casing 13.
  • reference numeral 21 designates a processing unit 21 for processing each output signal from the level regulator 19.
  • a general purpose personal computer or the like, for example, may be employed for this processing unit 21.
  • the level regulator 19 is connected to the processing unit 21 across a flat cable 23, said flat cable 23 being removably coupled with a socket 22 (see FIG. 1) provided on one side of the detector body 11.
  • Reference numeral 24 designates an operating portion such as a keyboard for outputting operation signals to the processing unit 21.
  • Reference numeral 25 designates a display portion such as a CRT or the like, for displaying the results of measurement of linear acceleration, angular acceleration and other data.
  • the processing unit 21 has a function to analyze output signals from each of the one-axis uni-directional accelerometers 1 through 6 and thus measure 6 DOF velocity and acceleration, through a control sequence of a program owned by the unit 21 itself.
  • a single one-axis uni-directional accelerometer is disposed on a rigid body B which moves in a static coordinate system or rest frame ⁇ o.
  • ⁇ b designates a coordinate system, fixed to the rigid body B in motion, in which a position vector °p b of the origin of the coordinate system ⁇ b, as viewed from the rest frame ⁇ o, is expressed by the following equation 1:
  • each left affix of the vector °p indicates a coordinate system the vector belongs to.
  • An arbitrary point "i" on the rigid body B can be expressed, using a position vector °r i , by the following equation 2:
  • the position vector °p i of the above point i as viewed from the rest frame ⁇ o will be the sum of the position vector °p b and the position vector °r i , as shown in the following equation 3:
  • the second term of the right side of the equation 7 expresses effects of centrifugal acceleration and angular acceleration that get mixed in the acceleration signals from the one-axis uni-directional accelerometer. As the equation 7 involves more unknown quantity than measured value, it is impossible to remove such centrifugal and angular effects, using such a single acceleration datum only.
  • the present invention proposes that a plurality of one-axis uni-directional accelerometers be mounted to different positions and in the different directions, and then respective acceleration data obtained therefrom be fused together.
  • the relationship expressed by the following equation 9 is derived from the equation 7: ##EQU3##
  • the regularity of the matrix °R depends upon the six uni-directional accelerometers' positions °r i and sensing directions °u i with respect to the rigid body B.
  • the 6-axis acceleration measuring method using six one-axis uni-directional accelerometers can be expressed theoretically as follows.
  • the six one-axis uni-directional accelerometers should be disposed in a manner that the matrix °R becomes regular, as above described. Also, the matrix °R is able to be transformed into the following equations 16 and 17:
  • the six one-axis uni-directional accelerometers 1 through 6 may meet the above condition to make the matrix R regular, they are desirably disposed, from a practical point of view, such as easy manufacture, as follows: 1) disposing all the one-axis uni-directional accelerometers 1 through 6 on the same plane (which results in a simple structure); 2) mounting as many accelerometers as possible to the same position.
  • FIGS. 1 and 5 illustrate an example of a preferred disposition of the one-axis uni-directional accelerometers 1 through 6 which meets such desirable conditions.
  • the origin of the coordinate system ⁇ b is set on an arbitrary point on the rigid body B, and then, each pair of the accelerometers is disposed every 120 degrees on the same plane around the origin of the coordinate system ⁇ b.
  • matrix b R is given by the following equation 21: ##EQU9##
  • one-axis uni-directional accelerometers 1 through 6 are mounted to three or more different positions on the same plane on the rigid body B to be measured, thus obtaining acceleration signals a1 through a6 which are output from each of the accelerometers 1 through 6, which is then followed by the processing expressed by the equation 13, using thus obtained acceleration signals a1 through a6 in order to separate centrifugal and angular effects involved in each one-axis uni-directional acceleration, whereby the 6-axis acceleration of the rigid body B is measured, with noticeable accuracy of measurement of the 6-axis acceleration as well as the motion of the rigid body B.
  • the above equation 13 includes the term of angular velocity ° ⁇ b which is non-linear, and thus it is practically difficult to carry out the measurement with only the respective measured vectors "a" from the one-axis uni-directional accelerometers 1 through 6. Further, for computing process by the processing unit 21, a discrete measurement equation is more convenient, and thus a discrete recurrence formula for processing the above non-linear term of angular velocity ° ⁇ b as well, must be given.
  • equation 23 needs ° ⁇ b(n) to calculate the following terms shown in equation 25 given below:
  • equation 23 can be expressed by the following equations 28 and 29: ##EQU13##
  • the 6-axis acceleration of the rigid body B can be measured successively using the equations 28, 29 and 30.
  • each of the one-axis uni-directional accelerometers 1-6 is disposed in a manner that each detector portion 7 to 9 is located at an apex of an equilateral triangle, as shown in FIGS. 1 and 5.
  • the characteristic of the one-axis uni-directional accelerometers 1 to 6 according the embodiment is such that the rated acceleration is 20 m/s 2 in terms of linear acceleration, and 80 rad/s 2 in terms of angular acceleration, while the resolution is 0.01 m/s 2 in terms of linear acceleration, and 0.02 rad/s 2 in terms of angular acceleration, respectively.
  • the sensitivity of linear acceleration depends on the respective characteristic of the one-axis uni-directional accelerometers 1 to 6.
  • the sensitivity relative to rotational direction however, it is adjustable by the aforesaid "r".
  • the mounting position "r" of the one-axis uni-directional accelerometers 1 to 6 was set at 250 mm as above mentioned.
  • the measurement device according to the embodiment was mounted on a vehicle, and then the motion of the vehicle travelling on a highway was measured.
  • the detector body 11 was fixedly mounted to under the driver's assistant seat, while a conventional measurement device was mounted to the center console (or substantially the center of gravity) of the vehicle for comparison.
  • the conventional measurement device meant here is a one which comprises a strain-gauge type three-axis-fused accelerometer of ⁇ 2 g rated sensitivity (i.e., the one where three of the one-axis uni-directional accelerometers 1 to 6 of the embodiment were combined together), and three one-axis mechanical rate gyroscopes with a rated sensitivity of ⁇ 20 deg/s (each having a built-in low pass filter of about 10 Hz) combined together.
  • a strain-gauge type three-axis-fused accelerometer of ⁇ 2 g rated sensitivity i.e., the one where three of the one-axis uni-directional accelerometers 1 to 6 of the embodiment were combined together
  • three one-axis mechanical rate gyroscopes with a rated sensitivity of ⁇ 20 deg/s each having a built-in low pass filter of about 10 Hz
  • FIGS. 7 and 8 each show a graph of the comparison of the measurement result between the measurement device of the embodiment and the conventional one.
  • the effects of angular velocity indicated by the equation 5 are included through the conventional measurement device also, the measurement results shown in FIGS. 7 and 8 remain un-corrected. Whilst, as the processing using the equations 28 and 29 were performed in the measurement device of the embodiment, attention was paid therein to separate the angular effects.
  • each of the one-axis uni-directional accelerometers 1 to 6 is structured in a manner fixed to the rigid body B through the base 12 in this embodiment, no Coriolis force will be developed even when an external force is applied to the rigid body B. Accordingly, the processing by the processing unit 21 at the later stage can be carried out without being affected by the Coriolis force.
  • the matrix °Ri showing the position vector of each of the one-axis uni-directional accelerometers 1 to 6 with respect to the directions of X,Y and Z axes becomes regular in theory, and thus the equation 13 holds, thus enabling the processing unit 21 to perform the processing with the effects by the centrifugal acceleration and the angular acceleration included in each one-axis uni-directional accelerometer being separated therefrom.
  • the one-axis uni-directional accelerometers 1 to 6 are mounted not three-dimensionally, but on the same plane, you have only to consider a two-dimensional positional relationship among the accelerometers 1 to 6 for realizing the accurate arrangement thereof, and thus, the motion of the rigid body B (acceleration, angular velocity and angular acceleration) can be measured very accurately with such simple arrangement.
  • a 6 DOF motion of the rigid body B is measured in such a manner that at least 6 one-axis uni-directional accelerometers 1 to 6 are fixed to three or more different positions on the same plane as that of a rigid body B, then carrying out the processing , using acceleration signals output from each of the one-axis uni-directional accelerometers 1 to 6 so that centrifugal and angular effects included in each one-axis uni-directional accelerometer may be separated therefrom, there can be provided a method for accurately measuring a 6 DOF motion of the rigid body B, using the least possible accelerometers and the simple arrangement thereof.
  • a measurement device comprises: at least 6 one-axis uni-directional accelerometers 1 to 6 fixed to three or more different positions on the same plane as that of a rigid body B; and a processing unit for processing so as to separate centrifugal and angular effects included in each of the one-axis uni-directional accelerometer 1 to 6, then there can be provided a device for accurately measuring a 6 DOF motion of the rigid body B, using the least possible accelerometers and the simple arrangement thereof.
  • one-axis uni-directional accelerometers there may be provided seven or more one-axis uni-directional accelerometers. It should be noted that as the number of the one-axis uni-directional accelerometers increases, the effects of noises included therein will be lessened, so that the measurement accuracy will be improved. In theory, however, at least six one-axis uni-directional accelerometers would suffice. It should also be noted that for the separation of the centrifugal and angular effects, the respective sensing directions °u i of the three or more one-axis uni-directional accelerometers 1 to 6 must not be either on the same straight line, or intersect one another at the same point.
  • the uniform characteristic would be preferred as it can realize the uniform response characteristic relative to each direction of degree of freedom. With such uniform characteristic, interference between each degree of freedom can be removed, thus obtaining 6-axis acceleration or angular acceleration with respect to any coordinate system. Further, the one-axis uni-directional accelerometers 1 to 6 can be calibrated comparatively easily, using the gravitational acceleration.
  • a measurement method and device according to the invention enables a measurement method and device according to the invention to be used not only for measurement of a motion of a robot, parallel manipulator, vehicle and the like, but also for advanced control system, using 6-axis acceleration.
  • the one-axis uni-directional accelerometers 1 to 6 of the embodiment are structured by providing sensors and various types of signal conditioners on the same silicone tip, the measuring method and device can be supplied at extremely low costs.
  • a measurement method and device according to the invention can be effectively used for practical use in various fields.

Abstract

A method and device for measuring a motion of a rigid body, using the least possible accelerometers that are simply arranged. One-axis uni-directional accelerometers 1 through 6 are each fixed to the rigid body through a base 12. Thus, no Coriolis force is developed even though an external force is applied thereto. The six one-axis uni-directional accelerometers 1 through 6 are mounted to three or more different positions relative to the rigid body. Consequently, a processing unit 21 can perform processing so that centrifugal and angular effects included in each one-axis uni-directional accelerometer may be separated. As the one-axis uni-directional accelerometers 1 through 6 are arranged on the same plane, you have only to consider two-dimensional positional relationship among the accelerometers for the accuracy of the arrangement thereof.

Description

BACKGROUND OF THE INVENTION
1. Filed of the Invention
The present invention relates to a method for measuring a 6 degrees of freedom (DOF) motion of a rigid body such as vehicle, and a device therefor.
2. Prior Art
In recent years, due to diversified types and enhanced performances of vehicles, the measurement and evaluation of human vibrations and vibration intervals, which provide criteria of how comfortable a rider in a car feels or so-called driving feeling (e.g. sense of maneuverability, stability, braking ability and the like), are becoming increasingly important. Particularly, it is widely expected that the evaluation relative to a wider range of subjects such as beginner drivers, aged persons, and so on will become increasingly important hereafter. For such evaluation, it is necessary to measure a motion of a moving vehicle with a sufficient band width (i.e., in the range of up to about DC 20 Hz).
Conventionally, a three-axis linear accelerometer and a three-axis mechanical rate gyroscope have been recognized as measurement devices for measurement of 6 degrees of freedom (DOF) motion of a rigid body such as vehicle. However, for a vehicle which performs such a complex motion of 6 DOF, the center of rotational motion is not constant, and acceleration signals to be detected by the linear accelerometer involve not only linear acceleration but also centrifugal and angular effects, which, therefore, must be separated therefrom. Whilst angular velocity data or angular acceleration data are necessary for such separation, a conventional rate gyroscope has such a low response characteristic that a measurable range has been limited to a motion of low speed, and its phase characteristics also is different from that of linear accelerometer, so that it has a drawback that it is not suitable for separation of signals.
Further, due to limited installing positions of such conventional measurement devices for real vehicles, coordinate transformation such as the transformation of measured linear acceleration and angular acceleration into arbitrary position or posture has often been necessary. For such coordinate transformation, the measured linear acceleration and angular acceleration must be combined with each other, for which, however, a conventional rate gyroscope is not considered suitable for the same reasons discussed above.
To solve the above-mentioned problems, there is proposed one method or device for measurement of angular acceleration (angular velocity) without the use of rate gyroscope, in which several (nine, for example) one-axis accelerometers are combined one another three-dimensionally. With such measurement method, however, there are problems such that the device becomes large-sized, requiring the accuracy of disposition of each one-axis accelerometer, and that the algorithm for analysis of output signals from the one-axis accelerometers becomes complicated.
Also, there are proposed other devices for measurement of this kind, some of the representatives of which are disclosed in Japanese Examined Patent Publication No. 6-90218 and Japanese Registered Patent Publication No. 2622297.
In the No. 6-90218 publication is proposed a device which comprises a casing and six support legs for restraining an overall 6 DOF motion of an inertia body, each support leg being disposed between the casing and the inertia body, having a force-detector mounted thereto, thus detecting urging forces applied to each leg thereby to measure all the accelerations of 6 DOF. However, as each leg is disposed three-dimensionally in a space inside the casing, the above-mentioned problems, such as the large-sized device and the requirement for accuracy of disposition, are unavoidable. In addition, as an inertia body is shifted by the forces from external due to the expansion or shrinkage of the legs, there would be structurally developed the Coriolis force. Nevertheless, as the outputs from the six force-detectors are simply converted into linear matrix for analysis, disregarding the Coriolis force and centrifugal effects when processing, you would be unable to measure accelerations other than slight acceleration and angular acceleration (or angular velocity). This is due to the fact that an inertia body in a three-dimensional space is subjected not only to inertial forces derived from accelerations and angular accelerations, but also to the Coriolis force and centrifugal forces, which act upon one another in a very complex manner, thus causing errors. Accordingly, you cannot expect the accurate measurement of 6 DOF motion in a three-dimensional space without taking such causes for errors into consideration.
On the other hand, in the No. 2622297 publication is proposed a device which comprises: first and second radial magnetic bearings and a pair of thrust magnetic bearings, said bearings holding in place a rotational body which rotates around the X axis; a detector for detecting the number of rotation of the rotational body; and five displacement-detectors for detecting the displacement of the rotational body, said displacement being defined in the directions of the Y, Z axes and the thrust, respectively, whereby the displacement acceleration and displacement angular acceleration of the rotational body are calculated and output, while correcting the displacement in the radial and thrust directions of the rotational body. Although the principle disclosed in this publication is analogous to the one disclosed in the No. 6-90218 publication, the structure becomes more complicated due to the presence of the rotational body. Whilst the prior art also teaches that the detection by the displacement-detectors may be performed, taking advantage of the Coriolis force which is developed when an angular velocity is developed around the Y axis of the rotational body, such method would result either in the incomplete separation of the Coriolis force and centrifugal effects, or in the dispersion of the output signals, and thus stable measurement would be impossible.
In other words, the conventional six-axis accelerometers have been structured without the sufficient analyses of the relationships of the acceleration and angular acceleration relative to an inertia body, even under the condition where the Coriolis force and centrifugal effects are developed structurally. Therefore, although they would work well relative to an inertia body moving on a two-dimensional plane, they, in a three-dimensional space, are unable to completely remove the effects of the Coriolis force and centrifugal forces which interfere complexly in the direction of each axis, or otherwise, they allow the output signals to be dispersed, and thus there is a likelihood that no stable measurement is able to be performed.
SUMMARY OF THE INVENTION
To eliminate the above-mentioned problems, it is, therefore, an object of the present invention to provide a method for measuring 6 DOF motion, which enables the accurate measurement of a motion of a rigid body, using the least possible accelerometers that are simply disposed.
Further, it is another object of the present invention to provide a device for measuring 6 DOF motion, which enables the accurate measurement of a motion of a rigid body, using the least possible accelerometers that are simply disposed.
To attain the above objects, there is provided a method for measuring a 6 DOF motion of a rigid body, which comprises the steps of: fixing at least six one-axis uni-directional accelerometers to three or more different positions on the same plane as that of a rigid body; and then carrying out processing, using acceleration signals output from each of the one-axis uni-directional accelerometers so that the effects of centrifugal acceleration and rotational angular acceleration included in each one-axis uni-directional accelerometer may be separated therefrom.
Also, there is provided a device for measuring a 6 DOF motion of a rigid body, which comprises: at least six one-axis unidirectional accelerometers fixed to three or more different positions on the same plane as that of a rigid body; and a processing unit for carrying out processing, using acceleration signals output from each of the one-axis uni-directional accelerometers so that the effects of centrifugal acceleration and rotational angular acceleration included in each one-axis uni-directional accelerometer may be separated therefrom.
BRIEF DESCRIPTION OF THE DRAWINGS
Other objects, features and advantages of the invention will be apparent to those skilled in the art from the following description of the preferred embodiments of the invention, wherein reference is made to the accompanying drawings, of which:
FIG. 1 is a plan view showing a device in accordance with an embodiment of the invention, particularly illustrating a detector body thereof.
FIG. 2 is a front view showing a main part of the detector body as shown in FIG. 1.
FIG. 3 is a block diagram showing an electrical structure of the device as shown in FIG. 1.
FIG. 4 is a schematic explanatory diagram illustrating a case where a single accelerometer is disposed on a rigid body.
FIG. 5 is a schematic explanatory diagram illustrating a case where several accelerometers are disposed on a desirable position on a rigid body.
FIG. 6 is a graph showing the frequency-acceleration output gain characteristics of a one-axis uni-directional accelerometer of the invention.
FIG. 7 is a graph showing the linear acceleration characteristics comparing between a conventional measurement device and a measurement device according to the invention.
FIG. 8 is a graph showing the angular velocity characteristics comparing between a conventional measurement device and a measurement device according to the invention.
FIG. 9 is a graph showing the power spectrum density characteristics of linear acceleration comparing between a conventional measurement device and a measurement device according to the invention.
FIG. 10 is a graph showing the power spectrum density characteristics of angular velocity comparing between a conventional measurement device and a measurement device according to the invention.
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter is explained an embodiment of the invention with reference to the attached drawings.
Initially, the structure of a detecting portion of a measurement device of the invention will be explained with reference to FIGS. 1 and 2.
Reference numeral 11 designates a detecting body whose outer shell is constructed of a flat base 12 and a casing 13 for covering the upper surface of the base 12, said casing 13 being made of transparent resin material, for example. On the base 12 are vertically provided several linkage bars 14. From the upper surface of the casing 13 are inserted screws 15 into the upper ends of the linkage bars 14, thus fixing the base 12 to the casing 13. Whilst the base 12 and the casing 13 are each hexagon-shaped in plan view, their configurations should not be limited to the same. The detector body 11 is mounted to an optional rigid body in motion, such as a moving vehicle,
Reference numerals 1 through 6 each designate a strain-gauge type or a capacitance type one-axis uni-directional accelerometer. In the present embodiment, the number of such one-axis unidirectional accelerometers is six, which is the minimal number to enable the accurate measuring of acceleration in terms of the X, Y and Z axes, and angular acceleration. These one-axis uni-directional accelerometers 1 through 6 each comprise a sensor and various types of signal conditioners formed on the same silicone tip, employing the uniform frequency response characteristic and phase characteristic. Each of the one-axis uni-directional accelerometers 1 through 6 is mounted onto a substrate 16 by soldering. Such one-axis uni-directional accelerometers 1 through 6, being basically structured by a silicone tip, enables the small-sizing of a measurement device. Further, as a signal processing circuit such as an amplifier, is integrated therewith, it is advantageous in that the structure of a hereinbelow-described processing unit 21 can be simplified. The base 12 is fixedly mounted to an object to be measured, i.e., a rigid body (not shown). In other words, the one-axis uni-directional accelerometers 1 through 6 are moved together with a rigid body when a force from external is applied to the rigid body, and thus, no Coriolis force is developed structurally. This is another advantage which conventional 6 DOF motion measurement devices do not have.
The one- axis uni-directional accelerometers 1, 3 and 5 are provided so that the respective sensing directions may coincide with the direction of the Z axis, which is orthogonal to the flat base 12. The remaining accelerometers 2, 4 and 6 are provided so that the respective sensing directions may coincide with any arbitrary directions parallel to the X-Y plane which is orthogonal to the said Z axis. Namely, a first group consisting of the one-axis uni-directional accelerometers 1, 3 and 5 has a sensing direction directed to the Z axis, while a second group consisting of the one-axis uni-directional accelerometers 2, 4 and 6 has a sensing direction directed to respective directions which are parallel to the X-Y plane. Between each substrate 16 for the accelerometers 1, 3 and 5 and the base 12 is provided an adjustment member 17 which allows respective heights of the one-asis uni-directional accelerometers 1, 3 and 5 to align to be the centers of the remaining accelerometers 2, 4 and 6. Although the adjustment member 17 is an optional one, it is desirable because it allows an initial point of each sensing direction of the one-axis uni-directional accelerometers 1, 3 and 5 to align with each sensing direction of the accelerometers 2, 4 and 6, so that the subsequent processing is simplified. In addition, on the base 12 are disposed L-shaped angle members 18, each having a vertical face. To the respective vertical faces of the angle members 18 are bonded respective upper flat faces of the one-axis uni-directional accelerometers 2, 4 and 6, whereby these accelerometers 2,4 and 6 as well as the respective substrates for mounting them thereto are each held in the vertical direction.
The one-axis uni-directional accelerometers 1 and 2 which construct a first detector portion 7 are provided integrally in approximately the same position, being close to each other. Likewise, the accelerometers 3 and 4 which construct a second detector portion 8, and the accelerometers 5 and 6 which construct a third detector portion 9, are also provided integrally in approximately the same positions, being close to each other, respectively. The first detector portion 7, the second detector portion 8 and the third detector portion 9 are each disposed in different positions on the base 12. Although the six one-axis uni-directional accelerometers 1 through 6 may be disposed on any arbitrary positions on the same plane, they must be positioned in at least three different positions on the same, the reason for which will be explained in a paragraph relating to a hereinafter-described measurement principle.
In the meantime, reference numeral 19 designates a level regulator, having several variable resistances. This level regulator 19 serves to suitably regulate the levels of output signals from each of the one-axis uni-directional accelerometers 1 through 6, but it is not always necessary to provide the same inside the detector body 11. Preferably, the casing 13 opposite to the level regulator 19 may be provided with an aperture in order that the regulation by the level regulator 19 may be carried out without opening or closing the casing 13.
In FIG. 3 which is a block diagram showing an electrical structure of a device according to the invention, reference numeral 21 designates a processing unit 21 for processing each output signal from the level regulator 19. A general purpose personal computer or the like, for example, may be employed for this processing unit 21. The level regulator 19 is connected to the processing unit 21 across a flat cable 23, said flat cable 23 being removably coupled with a socket 22 (see FIG. 1) provided on one side of the detector body 11. Reference numeral 24 designates an operating portion such as a keyboard for outputting operation signals to the processing unit 21. Reference numeral 25 designates a display portion such as a CRT or the like, for displaying the results of measurement of linear acceleration, angular acceleration and other data. The processing unit 21 has a function to analyze output signals from each of the one-axis uni-directional accelerometers 1 through 6 and thus measure 6 DOF velocity and acceleration, through a control sequence of a program owned by the unit 21 itself.
Next, the principle of the measurement of the acceleration developed on a moving rigid body according to an embodiment of the invention will be described in detail with reference to FIGS. 4 and 5.
In FIG. 4 which is drawn for the purpose of simplicity, a single one-axis uni-directional accelerometer is disposed on a rigid body B which moves in a static coordinate system or rest frame Σo. In the same Figure, Σb designates a coordinate system, fixed to the rigid body B in motion, in which a position vector °pb of the origin of the coordinate system Σb, as viewed from the rest frame Σo, is expressed by the following equation 1:
°p.sub.b =[°p.sub.bx °p.sub.by °p.sub.bz ].sup.TEquation 1
In the above equation 1, each left affix of the vector °p indicates a coordinate system the vector belongs to. An arbitrary point "i" on the rigid body B can be expressed, using a position vector °ri, by the following equation 2:
°r.sub.i =[°r.sub.ix °r.sub.iy °r.sub.iz ].sup.TEquation 2
At this time, the position vector °pi of the above point i as viewed from the rest frame Σo will be the sum of the position vector °pb and the position vector °ri, as shown in the following equation 3:
°p.sub.i =°p.sub.b +°r.sub.i          Equation 3
When the rigid body B is rotating around the origin of the coordinate system Σb at an angular velocity °ωb both sides of the above equation 3 are differentiated with respect to time t, thus obtaining a velocity relational equation as shown by the following equation 4:
°p.sub.i =°p.sub.b +°ω.sub.b ×°r.sub.i                                    Equation 4
Similarly, an acceleration relational equation is shown by the following equation 5:
°p.sub.i =°p.sub.b +°ω.sub.b ×°r.sub.i +°ω.sub.b ×(°ω.sub.b ×°r.sub.i)     Equation 5
Reviewing a case where the one-axis unidirectional accelerometer is mounted to the point i on the rigid body B, in which a unit vector for indicating the sensing direction of this one-axis unidirectional accelerometer is denoted by °ui, while the output (one-axis acceleration) of the same accelerometer by "ai", then this one-axis acceleration ai is expressed by the following equation 6:
a.sub.i =°u.sub.i.sup.T °p.sub.i             Equation 6
Then, the °pi of the equation 5 is substituted into that of the equation 6, so that the one-axis acceleration "ai" is expressed by the following equation 7: ##EQU1## where °Ri in the equation 7 can be expressed as a matrix shown below: ##EQU2##
The second term of the right side of the equation 7 expresses effects of centrifugal acceleration and angular acceleration that get mixed in the acceleration signals from the one-axis uni-directional accelerometer. As the equation 7 involves more unknown quantity than measured value, it is impossible to remove such centrifugal and angular effects, using such a single acceleration datum only.
Then, the present invention proposes that a plurality of one-axis uni-directional accelerometers be mounted to different positions and in the different directions, and then respective acceleration data obtained therefrom be fused together. Assuming that n one-axis uni-directional accelerometers are mounted to arbitrary position °ri on the rigid body B so that the respective sensing direction s may be °ui (i=1,2, . . . n), the relationship expressed by the following equation 9 is derived from the equation 7: ##EQU3##
In the above equation 9, one-axis acceleration "a" and matrix °R can be expressed by the following equation 10: ##EQU4##
6 DOF acceleration of the rigid body B can be given by a term shown by the following equation or formula 11:
[°p.sub.b.sup.T °ω.sub.b.sup.T ].sup.T Equation 11
Accordingly, by the above equation 9 is given a condition for the aforesaid one-axis acceleration "a" to extend in a six-dimensional space, as shown by the following equation 12:
rank °R=6                                           Equation 12
Particularly, when n=6 and rank °R=6, i.e., when the matrix °R is regular, 6 DOF acceleration of the rigid body B shown by the formula 11 can be determined with uniqueness through the equation 9. Accordingly, it will be assumed hereinafter that n=6 and the matrix °R is regular. In such case, the following equation 13 holds: ##EQU5##
As is apparent from the equation 9, the regularity of the matrix °R depends upon the six uni-directional accelerometers' positions °ri and sensing directions °ui with respect to the rigid body B.
In the meantime, whilst the equation 13 indicates the result according to the rest frame Σo, it is often more convenient to express the same according to the coordinate system Σb fixed to a vehicle, when the device of the invention is used for a vehicle. Accordingly, if a coordinate system transformation (rotation) matrix for transforming from the coordinate system Σb to the standard coordinate system Σo is denoted by °Ab, then the foregoing equation 6 can be expressed by the following equation 14: ##EQU6##
After transforming the equation 5 and etc. in the similar manner and then arranging thus obtained results, the following equation 15 is given: ##EQU7##
The 6-axis acceleration measuring method using six one-axis uni-directional accelerometers (n=6) can be expressed theoretically as follows.
Namely, for the equation 13 to hold true, the six one-axis uni-directional accelerometers should be disposed in a manner that the matrix °R becomes regular, as above described. Also, the matrix °R is able to be transformed into the following equations 16 and 17:
°R=°A.sub.b.sup.b R                          Equation 16
.sup.b R=.sup.b U.sup.b R,                                 Equation 17
Where the b U and b R in the above equations 16 and 17 can be expressed by the following equation 18: ##EQU8##
For the equation 16 to satisfy the condition defined by the equation 12, b R should become regular, as °Ab is regular. As rank b U=6 in the equation 17, at least the following equation 19 must hold.
rank .sup.b R=6                                            Equation 19
Taking the following equation 20 into consideration, at least three of from b R1 through b R6 must not be the same.
rank[(I.sub.3 -.sup.b R.sub.1).sup.T (I.sub.3 -.sup.b R.sub.j).sup.T ].sup.T ≦5,(i,j=1,2, . . . ,6,i≠j)           Equation 20
In other words, this supports the reason why the six one-axis uni-directional accelerometers 1 through 6 must be mounted to at least three different positions.
Although a variety of positions of the six one-axis uni-directional accelerometers 1 through 6 may meet the above condition to make the matrix R regular, they are desirably disposed, from a practical point of view, such as easy manufacture, as follows: 1) disposing all the one-axis uni-directional accelerometers 1 through 6 on the same plane (which results in a simple structure); 2) mounting as many accelerometers as possible to the same position.
FIGS. 1 and 5 illustrate an example of a preferred disposition of the one-axis uni-directional accelerometers 1 through 6 which meets such desirable conditions. In this case, the origin of the coordinate system Σb is set on an arbitrary point on the rigid body B, and then, each pair of the accelerometers is disposed every 120 degrees on the same plane around the origin of the coordinate system Σb. At this time, matrix b R is given by the following equation 21: ##EQU9##
It is to be noted that the matrix b R is regular, of which the inverse matrix is given by the following equation 22: ##EQU10##
Namely, according to the foregoing embodiment of the invention, as least six one-axis uni-directional accelerometers 1 through 6 are mounted to three or more different positions on the same plane on the rigid body B to be measured, thus obtaining acceleration signals a1 through a6 which are output from each of the accelerometers 1 through 6, which is then followed by the processing expressed by the equation 13, using thus obtained acceleration signals a1 through a6 in order to separate centrifugal and angular effects involved in each one-axis uni-directional acceleration, whereby the 6-axis acceleration of the rigid body B is measured, with noticeable accuracy of measurement of the 6-axis acceleration as well as the motion of the rigid body B.
In the meantime, the above equation 13 includes the term of angular velocity °ωb which is non-linear, and thus it is practically difficult to carry out the measurement with only the respective measured vectors "a" from the one-axis uni-directional accelerometers 1 through 6. Further, for computing process by the processing unit 21, a discrete measurement equation is more convenient, and thus a discrete recurrence formula for processing the above non-linear term of angular velocity °ωb as well, must be given.
If sampling intervals of data obtained from each of the one-axis uni-directional accelerometers 1 through 6 are denoted as Δt (second), and the nth sampling value of the above measured vectors "a" denoted as a(n), then the equation 13 can be expressed by the following equation 23: ##EQU11## where the f(n) is expressed by the following equation 24: ##EQU12##
Here, the above equation 23 needs °ωb(n) to calculate the following terms shown in equation 25 given below:
°R.sup.-1 (n) and f(n)                              Equation 25
Hence, the relationship defined by the following equation 26 is used, while for respective terms in equation 27 are used the (n-1)th values.
°ω.sub.b (n)=°ω.sub.b (n-1)+°ω.sub.b (n)t                                                      Equation 26
f(n),°u.sub.i (n),°r.sub.i (n),i=1,2, . . . ,6°ω.sub.b (n)                               Equation 27
That is, the equation 23 can be expressed by the following equations 28 and 29: ##EQU13##
Using these equations 28 and 29 requires initial values °pb (1) and °ωb (1), at t=0 (n=1), but each may be a value shown in the following equation 30 for a vehicle or the like.
When t=0, °p.sub.b (1)=°ω.sub.b (1)=0  Equation 30
Thus, by recording acceleration signals from each of the one-axis uni-directional accelerometers 1-6 at specific time intervals, the 6-axis acceleration of the rigid body B can be measured successively using the equations 28, 29 and 30.
Hereinafter is described an example of an experiment where a 6 DOF motion measurement method and a device therefor according to the embodiment of the invention were employed for measuring the 6-axis acceleration of a vehicle in motion. In the present embodiment, each of the one-axis uni-directional accelerometers 1-6 is disposed in a manner that each detector portion 7 to 9 is located at an apex of an equilateral triangle, as shown in FIGS. 1 and 5. In the equations 21 and 22, the mounting position of each of the detector portions 7 to 9 is set at r=250 mm, while the six one-axis uni-directional accelerometers 1 to 6 are each of strain-gauge type, displaying uniform characteristic (rated to ±2 g). FIG. 6 shows the response characteristic of the uni-directional accelerometers 1 to 6 with respect to temperature. As silicone oil was used here as a damping material for the one-axis uni-directional accelerometers 1 to 6, the response characteristic slightly varied, depending on ambient temperature, which, however, was found flat up to a range of DC 30 Hz at ambient temperature of 25° C. Specifically, when incorporating the measurement device of the invention into a vehicle, it is desirable to use the one-axis uni-directional accelerometers 1 to 6 of such characteristic, as the movement of the vehicle in motion can be accurately measured with a sufficient band width.
12 bit A/D conversion was performed at sampling rate of 60 Hz, relative to the acceleration measurement signals from each of the one-axis uni-directional accelerometers 1 to 6, which were then taken in the processing unit 21 or personal computer to carry out the processing based on the equations 28 and 29, whereby the 6-axis accelerations were measured successively. In the meantime, the above sampling rate should be suitably determined, in view of the characteristics of the respective one-axis uni-directional accelerometers 1 to 6 and an object to be measured. The characteristic of the measurement device depends on the characteristic of each uni-directional accelerometer 1 through 6 and the characteristic defined by the equation 28. The characteristic of the one-axis uni-directional accelerometers 1 to 6 according the embodiment is such that the rated acceleration is 20 m/s2 in terms of linear acceleration, and 80 rad/s2 in terms of angular acceleration, while the resolution is 0.01 m/s2 in terms of linear acceleration, and 0.02 rad/s2 in terms of angular acceleration, respectively.
As is apparent from the equations 19, 28 and so on, the sensitivity of linear acceleration depends on the respective characteristic of the one-axis uni-directional accelerometers 1 to 6. For the sensitivity relative to rotational direction, however, it is adjustable by the aforesaid "r". As an object to be measured is a vehicle in this example, its characteristic was taken into consideration, such that the mounting position "r" of the one-axis uni-directional accelerometers 1 to 6 was set at 250 mm as above mentioned.
Then, the measurement device according to the embodiment was mounted on a vehicle, and then the motion of the vehicle travelling on a highway was measured. The detector body 11 was fixedly mounted to under the driver's assistant seat, while a conventional measurement device was mounted to the center console (or substantially the center of gravity) of the vehicle for comparison. The conventional measurement device meant here is a one which comprises a strain-gauge type three-axis-fused accelerometer of ±2 g rated sensitivity (i.e., the one where three of the one-axis uni-directional accelerometers 1 to 6 of the embodiment were combined together), and three one-axis mechanical rate gyroscopes with a rated sensitivity of ±20 deg/s (each having a built-in low pass filter of about 10 Hz) combined together.
FIGS. 7 and 8 each show a graph of the comparison of the measurement result between the measurement device of the embodiment and the conventional one. In the meantime, although the effects of angular velocity indicated by the equation 5 are included through the conventional measurement device also, the measurement results shown in FIGS. 7 and 8 remain un-corrected. Whilst, as the processing using the equations 28 and 29 were performed in the measurement device of the embodiment, attention was paid therein to separate the angular effects.
For the linear acceleration shown in FIG. 7, there can be noted slight differences between the measurement device of the embodiment and the conventional one. These slight differences presumably resulted from whether the aforesaid effects of angular velocity were taken into consideration or not. For the angular velocity shown in FIG. 8, more high frequency components seem to be included through the measurement device of the embodiment.
Then, the measurement data shown in FIGS. 7 and 8 were fast Fourier transformed (FFT) by the processing unit 21, and then power spectrum density was calculated, thus obtaining results shown in FIGS. 9 and 10. For the linear acceleration shown in FIG. 9, there can be noted substantially no differences in measurement result between the measurement device of the embodiment and the conventional one. This is presumably due to the fact that both measurement devices use substantially the same accelerometers with respect to the linear direction. For the rotational direction shown in FIG. 10, there can be noted an inclination for the frequency components of the conventional one to decrease by a few Hz or more, which is presumably due to the influence by the low pass filter built in the rate gyroscope.
Incidentally, as the present embodiment requires the numerical integration as shown by the equation 26, errors are accumulated due to the drift of each of the one-axis uni-directional accelerometers 1 to 6. For the rigid body B such as a vehicle which normally does not make a continuous rotational movement, however, such drift errors can be reduced to a considerable extent, by incorporating an indefinite integration having a high pass characteristic of about 10 sec. time constant into the processing by the processing unit 21, instead of the numerical integration by the equation 26.
As seen from the foregoing, as each of the one-axis uni-directional accelerometers 1 to 6 is structured in a manner fixed to the rigid body B through the base 12 in this embodiment, no Coriolis force will be developed even when an external force is applied to the rigid body B. Accordingly, the processing by the processing unit 21 at the later stage can be carried out without being affected by the Coriolis force. Further, with at least 6 one-axis uni-directional accelerometers 1 to 6 located at three or more different positions relative to the rigid body B, the matrix °Ri showing the position vector of each of the one-axis uni-directional accelerometers 1 to 6 with respect to the directions of X,Y and Z axes becomes regular in theory, and thus the equation 13 holds, thus enabling the processing unit 21 to perform the processing with the effects by the centrifugal acceleration and the angular acceleration included in each one-axis uni-directional accelerometer being separated therefrom. Furthermore, as the processing can be carried out, using the acceleration signals from the respective 6 one-axis uni-directional accelerometer 1 to 6 only, you are free from any concerns about the low response characteristic, the different phase characteristics and the like, which would go together with the conventional one having rate gyroscopes combined therewith.
Moreover, as the one-axis uni-directional accelerometers 1 to 6 are mounted not three-dimensionally, but on the same plane, you have only to consider a two-dimensional positional relationship among the accelerometers 1 to 6 for realizing the accurate arrangement thereof, and thus, the motion of the rigid body B (acceleration, angular velocity and angular acceleration) can be measured very accurately with such simple arrangement.
In other words, if a 6 DOF motion of the rigid body B is measured in such a manner that at least 6 one-axis uni-directional accelerometers 1 to 6 are fixed to three or more different positions on the same plane as that of a rigid body B, then carrying out the processing , using acceleration signals output from each of the one-axis uni-directional accelerometers 1 to 6 so that centrifugal and angular effects included in each one-axis uni-directional accelerometer may be separated therefrom, there can be provided a method for accurately measuring a 6 DOF motion of the rigid body B, using the least possible accelerometers and the simple arrangement thereof.
Also, if a measurement device comprises: at least 6 one-axis uni-directional accelerometers 1 to 6 fixed to three or more different positions on the same plane as that of a rigid body B; and a processing unit for processing so as to separate centrifugal and angular effects included in each of the one-axis uni-directional accelerometer 1 to 6, then there can be provided a device for accurately measuring a 6 DOF motion of the rigid body B, using the least possible accelerometers and the simple arrangement thereof.
Alternatively, there may be provided seven or more one-axis uni-directional accelerometers. It should be noted that as the number of the one-axis uni-directional accelerometers increases, the effects of noises included therein will be lessened, so that the measurement accuracy will be improved. In theory, however, at least six one-axis uni-directional accelerometers would suffice. It should also be noted that for the separation of the centrifugal and angular effects, the respective sensing directions °ui of the three or more one-axis uni-directional accelerometers 1 to 6 must not be either on the same straight line, or intersect one another at the same point.
Although the characteristics of the one-axis uni-directional accelerometers does not need to be uniform, the uniform characteristic would be preferred as it can realize the uniform response characteristic relative to each direction of degree of freedom. With such uniform characteristic, interference between each degree of freedom can be removed, thus obtaining 6-axis acceleration or angular acceleration with respect to any coordinate system. Further, the one-axis uni-directional accelerometers 1 to 6 can be calibrated comparatively easily, using the gravitational acceleration.
Utilizing the above-mentioned features enables a measurement method and device according to the invention to be used not only for measurement of a motion of a robot, parallel manipulator, vehicle and the like, but also for advanced control system, using 6-axis acceleration. Furthermore, as the one-axis uni-directional accelerometers 1 to 6 of the embodiment are structured by providing sensors and various types of signal conditioners on the same silicone tip, the measuring method and device can be supplied at extremely low costs. Thus, a measurement method and device according to the invention can be effectively used for practical use in various fields.

Claims (14)

What is claimed:
1. A method for measuring a 6 DOF motion of a rigid body, which comprises the steps of:
fixing at least six one-axis uni-directional accelerometers to three or more different positions on the same plane as that of a rigid body; and
carrying out processing, using acceleration signals output from each of the one-axis uni-directional accelerometers so that the effects of centrifugal acceleration and rotational angular acceleration included in each one-axis uni-directional accelerometer may be separated therefrom.
2. A method for measuring a 6 DOF motion of a rigid body according to claim 1,
wherein the one-axis uni-directional accelerometers are mounted to arbitrary positions denoted by position vector °ri on the rigid body so that vectors in the sensing directions may become °ui (i=1,2, . . . n, its left affix indicating a coordinate system to which the vector belongs), whereby a 6 degrees of freedom acceleration of the rigid body in a static coordinate standard system Σo shown by the following equation:
[°pb.sup.T °ωb.sup.T ].sup.T
is calculated, based on the following equation: ##EQU14## where the °pb indicates the position of the origin of a coordinate system Σb fixed to the rigid body as viewed from the static coordinate standard system Σo, and the °ωb indicates an angular velocity of the rigid body rotating around the origin of the coordinate system Σb, while the one-axis acceleration "a" and the matrix °R are expressed by the following equations, respectively: ##EQU15##
3. A method for measuring a 6 DOF motion of a rigid body according to claim 2, wherein the number (n) of said one-axis uni-directional accelerometers is six, while the said one-axis uni-directional accelerometers are arranged so that the matrix °R may become regular, whereby a 6 degrees of freedom acceleration of the rigid body in the static coordinate standard system Σo shown by the following equation:
[°pb.sup.T °ωb.sup.T ].sup.T
is calculated, based on the following equation: ##EQU16##
4. A method for measuring a 6 DOF motion according to claim 3, wherein a 6 degrees of freedom acceleration of the rigid body in the coordinate system Σb fixed to the rigid body is calculated based on the following equation:
5. A method for measuring a 6 DOF motion according to claim 3, wherein data from each one-axis uni-directional accelerometer are obtained at sampling intervals of Δt (second), whereby a 6 degrees of freedom acceleration of the rigid body in the static coordinate standard system To shown by the following equation:
[°pb.sup.T °ωb.sup.T ].sup.T
is calculated based on the following equations: ##EQU17## where a(n) indicates the nth sampling value of measured value vector, and ##EQU18## where
When t=0, °pb(1)=°ωb(1)=0 ##EQU19##
6. A method for measuring a 6 DOF motion according to claim 1, wherein the frequency response characteristic and phase characteristic of each one-axis uni-directional accelerometer is uniform.
7. A method for measuring a 6 DOF motion according to claim 1, wherein the one-axis uni-directional accelerometers are paired respectively, disposed close to one another nearly on the same position, in which a first one of each pair of one-axis uni-directional accelerometers has a sensing direction directed to the Z-axis, while the second one of each pair of uni-directional accelerometers has a sensing direction parallel to the X-Y plane, with the height of the first one of each pair of one-axis uni-directional accelerometers aligned to the center of the second one of each pair of one-axis uni-directional accelerometers.
8. A device for measuring a 6 DOF motion of a rigid body, which comprises: at least six one-axis uni-directional accelerometers fixed to three or more different positions on the same plane as that of a rigid body; and
a processing unit for calculating the 6 DOF motion of the rigid body, said processing unit carrying out processing, using acceleration signals output from each of the one-axis uni-directional accelerometers so that the effects of centrifugal acceleration and rotational angular acceleration included in each one-axis uni-directional accelerometer may be separated therefrom.
9. A device for measuring a 6 DOF motion of a rigid body according to claim 8,
wherein the one-axis uni-directional accelerometers are mounted to arbitrary positions denoted by position vector °ri on the rigid body so that vectors in the sensing directions may become °ui (i=1,2, . . . n, its left affix indicating a coordinate system to which the vector belongs), whereby a 6 degrees of freedom acceleration of the rigid body in a static coordinate standard system Σo shown by the following equation:
[°pb.sup.T °ωb.sup.T ].sup.T
is calculated by said processing unit, based on the following equation: ##EQU20## where the °pb indicates the position of the origin of a coordinate system Σb fixed to the rigid body as viewed from the static coordinate standard system Σo, and the °ωb indicates an angular velocity of the rigid body rotating around the origin of the coordinate system Σb, while the one-axis acceleration "a" and the matrix °R are expressed by the following equations, respectively: ##EQU21##10.
10. A device for measuring a 6 DOF motion of a rigid body according to claim 9, wherein the number (n) of said one-axis uni-directional accelerometers is six, while the said one-axis uni-directional accelerometers are arranged so that the matrix °R may become regular, whereby a 6 degrees of freedom acceleration of the rigid body in the static coordinate standard system Σo shown by the following equation:
[°pb.sup.T °ωb.sup.T ].sup.T
is calculated by said processing unit, based on the following equation: ##EQU22##
11. A device for measuring a 6 DOF motion according to claim 10, wherein a 6 degrees of freedom acceleration of the rigid body in the coordinate system Σb fixed to the rigid body is calculated by said processing unit based on the following equation:
12. A device for measuring a 6 DOF motion according to claim 10, wherein said processing unit obtains data from each one-axis uni-directional accelerometer at sampling intervals of Δt (second), whereby a 6 degrees of freedom acceleration of the rigid body in the static coordinate standard system Σo shown by the following equation:
[°pb.sup.T °ωb.sup.T ].sup.T
is calculated by said processing unit, based on the following equations: ##EQU23## where a(n) indicates the nth sampling value of measured value vector ##EQU24## where
When t=0, °pb(1)=°ωb(1)=0 ##EQU25##
13. A device for measuring a 6 DOF motion according to claim 8, wherein the frequency response characteristic and phase characteristic of each one-axis uni-directional accelerometer is uniform.
14. A device for measuring a 6 DOF motion according to claim 8, wherein the one-axis uni-directional accelerometers are paired respectively, disposed close to one another nearly on the same position, in which a first one of each pair of one-axis uni-directional accelerometers has a sensing direction directed to the Z-axis, while the second one of each pair of uni-directional accelerometers has a sensing direction parallel to the X-Y plane, and wherein said device further comprises a level regulator for allowing the height of the first one of each pair of one-axis uni-directional accelerometers to be aligned to the center of the second one of each pair of one-axis uni-directional accelerometers.
US09/349,598 1999-07-09 1999-07-09 Method for measuring 6 degrees of freedom motion and device therefor Expired - Fee Related US6128955A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
US09/349,598 US6128955A (en) 1999-07-09 1999-07-09 Method for measuring 6 degrees of freedom motion and device therefor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
US09/349,598 US6128955A (en) 1999-07-09 1999-07-09 Method for measuring 6 degrees of freedom motion and device therefor

Publications (1)

Publication Number Publication Date
US6128955A true US6128955A (en) 2000-10-10

Family

ID=23373133

Family Applications (1)

Application Number Title Priority Date Filing Date
US09/349,598 Expired - Fee Related US6128955A (en) 1999-07-09 1999-07-09 Method for measuring 6 degrees of freedom motion and device therefor

Country Status (1)

Country Link
US (1) US6128955A (en)

Cited By (36)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6578420B1 (en) * 1997-01-28 2003-06-17 Microsensors, Inc. Multi-axis micro gyro structure
US20030176962A1 (en) * 2002-03-06 2003-09-18 Traylor Chadwick Ray Accelerometer gauge using solid state accelerometers
US20040177663A1 (en) * 2003-03-11 2004-09-16 Harrow Products, Inc. Override assembly for door lock systems having a clutch mechanism
US6810739B1 (en) * 2003-07-30 2004-11-02 The Boeing Company Accelerometer augmented leveling device
US20050022598A1 (en) * 2003-07-29 2005-02-03 The Boeing Company Single Plate Capacitive Acceleration Derivative Detector
US20050216146A1 (en) * 2004-03-23 2005-09-29 Continental Teves, Inc. Body state estimation of a vehicle
FR2868843A1 (en) * 2004-10-13 2005-10-14 Siemens Vdo Automotive Sas Motor vehicle`s longitudinal, lateral and angular acceleration determining device has identical acceleration sensors which are linear and placed tangentially to predetermined radiation circles
US6997882B1 (en) 2001-12-21 2006-02-14 Barron Associates, Inc. 6-DOF subject-monitoring device and method
US20060069469A1 (en) * 2004-09-29 2006-03-30 Campbell Ray F Integrated capacitive bridge and integrated flexure functions inertial measurement unit
US20060098845A1 (en) * 2004-11-05 2006-05-11 Kyprianos Papademetriou Digital signal processing methods, systems and computer program products that identify threshold positions and values
US20060111798A1 (en) * 2004-11-22 2006-05-25 Campbell Ray F Compensated composite structure
US20060123643A1 (en) * 2004-12-14 2006-06-15 The Boeing Company Leveling Device
US7228739B2 (en) 2004-11-23 2007-06-12 The Boeing Company Precision flexure plate
US7237437B1 (en) * 2005-10-27 2007-07-03 Honeywell International Inc. MEMS sensor systems and methods
US20070153631A1 (en) * 2005-12-29 2007-07-05 Jean-Paul Menard Six-component seismic data acquisition system
US20070220974A1 (en) * 2005-04-14 2007-09-27 The Boeing Company Extended accuracy flexured plate dual capacitance accelerometer
WO2007127537A1 (en) 2006-03-15 2007-11-08 Qualcomm Incorporated Sensor-based orientation systeim
US20080011081A1 (en) * 2004-12-09 2008-01-17 The Boeing Company Magnetic null accelerometer
US20080092643A1 (en) * 2004-10-20 2008-04-24 Jones Robert H Sensor Configuration
US20080148850A1 (en) * 2002-05-09 2008-06-26 Hanson David S Coplanar mounting member for a MEM sensor
CN100449316C (en) * 2006-08-13 2009-01-07 重庆大学 Arrangement structure of sensing elements of six-axle acceleration transducer
US20090288485A1 (en) * 2008-05-22 2009-11-26 Rosemount Aerospace Inc. High bandwidth inertial measurement unit
US20100005885A1 (en) * 2005-06-03 2010-01-14 Albert-Ludwigs-Universität Freiburg Method and Device for Determining the Relative Position, Speed and/or Acceleration of a Body
DE102009000880A1 (en) * 2009-02-16 2010-03-04 Robert Bosch Gmbh For the detection of rotary movements, two acceleration sensors register rotary and linear accelerations
US20110209544A1 (en) * 2008-11-04 2011-09-01 Elbit Systems Ltd. Sensor cluster navigation device and method
US20110254760A1 (en) * 2010-04-20 2011-10-20 Invensense, Inc. Wireless Motion Processing Sensor Systems Suitable for Mobile and Battery Operation
WO2011144883A1 (en) * 2010-05-19 2011-11-24 Salisbury Nhs Foundation Trust Accelerometer assembly and the use thereof
US20120078570A1 (en) * 2010-09-29 2012-03-29 Apple Inc. Multiple accelerometer system
US20130068017A1 (en) * 2011-09-20 2013-03-21 Noel Perkins Apparatus and method for analyzing the motion of a body
US20130312518A1 (en) * 2012-05-24 2013-11-28 Sagem Defense Securite Inertial unit having vibrating gyros mounted on a carousel, and an angle-measurement method
US20140318245A1 (en) * 2011-11-24 2014-10-30 Dainese S.P.A. Impact detection device
US9032794B2 (en) 2012-08-09 2015-05-19 The Regents Of The University Of Michigan Pitcher training apparatus and method using a ball with an embedded inertial measurement unit
US9140717B2 (en) 2011-09-20 2015-09-22 The Regents Of The University Of Michigan Apparatus and method for identifying and analyzing the free flight dynamics of a body
US9213889B2 (en) 2013-03-28 2015-12-15 The Regents Of The University Of Michigan Athlete speed prediction method using data from attached inertial measurement unit
CN113203580A (en) * 2021-05-10 2021-08-03 徐工集团工程机械有限公司 Engineering vehicle stability evaluation method, device and system and engineering vehicle
CN114646440A (en) * 2022-03-16 2022-06-21 北京卫星环境工程研究所 Three-axis six-degree-of-freedom vibration control input and output coordinate transformation matrix construction method

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4590801A (en) * 1983-09-02 1986-05-27 Sundstrand Data Control, Inc. Apparatus for measuring inertial specific force and angular rate of a moving body
JPH0690218A (en) * 1992-09-07 1994-03-29 Toshiba Corp Information transmission system
US5383363A (en) * 1993-02-10 1995-01-24 Ford Motor Company Inertial measurement unit providing linear and angular outputs using only fixed linear accelerometer sensors

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4590801A (en) * 1983-09-02 1986-05-27 Sundstrand Data Control, Inc. Apparatus for measuring inertial specific force and angular rate of a moving body
JPH0690218A (en) * 1992-09-07 1994-03-29 Toshiba Corp Information transmission system
US5383363A (en) * 1993-02-10 1995-01-24 Ford Motor Company Inertial measurement unit providing linear and angular outputs using only fixed linear accelerometer sensors

Cited By (58)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6578420B1 (en) * 1997-01-28 2003-06-17 Microsensors, Inc. Multi-axis micro gyro structure
US6997882B1 (en) 2001-12-21 2006-02-14 Barron Associates, Inc. 6-DOF subject-monitoring device and method
US20030176962A1 (en) * 2002-03-06 2003-09-18 Traylor Chadwick Ray Accelerometer gauge using solid state accelerometers
US6856884B2 (en) * 2002-03-06 2005-02-15 Chadwick Ray Traylor Accelerometer gauge using solid state accelerometers
US20080148850A1 (en) * 2002-05-09 2008-06-26 Hanson David S Coplanar mounting member for a MEM sensor
US20040177663A1 (en) * 2003-03-11 2004-09-16 Harrow Products, Inc. Override assembly for door lock systems having a clutch mechanism
US20050022598A1 (en) * 2003-07-29 2005-02-03 The Boeing Company Single Plate Capacitive Acceleration Derivative Detector
US7124634B2 (en) 2003-07-29 2006-10-24 The Boeing Company Single plate capacitive acceleration derivative detector
US6810739B1 (en) * 2003-07-30 2004-11-02 The Boeing Company Accelerometer augmented leveling device
US20050216146A1 (en) * 2004-03-23 2005-09-29 Continental Teves, Inc. Body state estimation of a vehicle
US7831354B2 (en) * 2004-03-23 2010-11-09 Continental Teves, Inc. Body state estimation of a vehicle
US20060069469A1 (en) * 2004-09-29 2006-03-30 Campbell Ray F Integrated capacitive bridge and integrated flexure functions inertial measurement unit
US7310577B2 (en) 2004-09-29 2007-12-18 The Boeing Company Integrated capacitive bridge and integrated flexure functions inertial measurement unit
FR2868843A1 (en) * 2004-10-13 2005-10-14 Siemens Vdo Automotive Sas Motor vehicle`s longitudinal, lateral and angular acceleration determining device has identical acceleration sensors which are linear and placed tangentially to predetermined radiation circles
US9057643B2 (en) 2004-10-20 2015-06-16 Schlumberger Technology Corporation Seismic sensor with four uniaxial motion sensing elements having substantially the same angle to the vertical and horizontal directions
US20080092643A1 (en) * 2004-10-20 2008-04-24 Jones Robert H Sensor Configuration
US20060098845A1 (en) * 2004-11-05 2006-05-11 Kyprianos Papademetriou Digital signal processing methods, systems and computer program products that identify threshold positions and values
US7583819B2 (en) 2004-11-05 2009-09-01 Kyprianos Papademetriou Digital signal processing methods, systems and computer program products that identify threshold positions and values
US7360425B2 (en) 2004-11-22 2008-04-22 The Boeing Company Compensated composite structure
US20060111798A1 (en) * 2004-11-22 2006-05-25 Campbell Ray F Compensated composite structure
US7228739B2 (en) 2004-11-23 2007-06-12 The Boeing Company Precision flexure plate
US20080011081A1 (en) * 2004-12-09 2008-01-17 The Boeing Company Magnetic null accelerometer
US7331229B2 (en) 2004-12-09 2008-02-19 The Boeing Company Magnetic null accelerometer
US7137208B2 (en) * 2004-12-14 2006-11-21 The Boeing Company Leveling device
US20060123643A1 (en) * 2004-12-14 2006-06-15 The Boeing Company Leveling Device
US7296470B2 (en) 2005-04-14 2007-11-20 The Boeing Company Extended accuracy flexured plate dual capacitance accelerometer
US20070220974A1 (en) * 2005-04-14 2007-09-27 The Boeing Company Extended accuracy flexured plate dual capacitance accelerometer
US8037759B2 (en) * 2005-06-03 2011-10-18 Albert-Ludwigs Universitat Freiburg Method and device for determining the relative position, velocity and/or acceleration of a body
US20100005885A1 (en) * 2005-06-03 2010-01-14 Albert-Ludwigs-Universität Freiburg Method and Device for Determining the Relative Position, Speed and/or Acceleration of a Body
US7237437B1 (en) * 2005-10-27 2007-07-03 Honeywell International Inc. MEMS sensor systems and methods
US7474591B2 (en) * 2005-12-29 2009-01-06 Sercel Six-component seismic data acquisition system
GB2447001B (en) * 2005-12-29 2010-09-08 Sercel Rech Const Elect System for acquiring seismic data with six components
US20070153631A1 (en) * 2005-12-29 2007-07-05 Jean-Paul Menard Six-component seismic data acquisition system
EP2002209A1 (en) * 2006-03-15 2008-12-17 QUALCOMM Incorporated Sensor-based orientation system
WO2007127537A1 (en) 2006-03-15 2007-11-08 Qualcomm Incorporated Sensor-based orientation systeim
US8910522B2 (en) 2006-03-15 2014-12-16 Qualcomm Incorporated Sensor-based orientation system
CN100449316C (en) * 2006-08-13 2009-01-07 重庆大学 Arrangement structure of sensing elements of six-axle acceleration transducer
US20090288485A1 (en) * 2008-05-22 2009-11-26 Rosemount Aerospace Inc. High bandwidth inertial measurement unit
US8020442B2 (en) * 2008-05-22 2011-09-20 Rosemount Aerospace Inc. High bandwidth inertial measurement unit
US8756995B2 (en) 2008-11-04 2014-06-24 Elbit Systems Ltd. Device and method for combining samples from an inertial measurement sensor cluster
US20110209544A1 (en) * 2008-11-04 2011-09-01 Elbit Systems Ltd. Sensor cluster navigation device and method
US20140298906A1 (en) * 2008-11-04 2014-10-09 Elbit Systems Ltd. Device and method for combining samples from an inertial measurement sensor cluster
DE102009000880A1 (en) * 2009-02-16 2010-03-04 Robert Bosch Gmbh For the detection of rotary movements, two acceleration sensors register rotary and linear accelerations
US20110254760A1 (en) * 2010-04-20 2011-10-20 Invensense, Inc. Wireless Motion Processing Sensor Systems Suitable for Mobile and Battery Operation
US8760392B2 (en) * 2010-04-20 2014-06-24 Invensense, Inc. Wireless motion processing sensor systems suitable for mobile and battery operation
WO2011144883A1 (en) * 2010-05-19 2011-11-24 Salisbury Nhs Foundation Trust Accelerometer assembly and the use thereof
US20120078570A1 (en) * 2010-09-29 2012-03-29 Apple Inc. Multiple accelerometer system
US20130068017A1 (en) * 2011-09-20 2013-03-21 Noel Perkins Apparatus and method for analyzing the motion of a body
US9140717B2 (en) 2011-09-20 2015-09-22 The Regents Of The University Of Michigan Apparatus and method for identifying and analyzing the free flight dynamics of a body
US20140318245A1 (en) * 2011-11-24 2014-10-30 Dainese S.P.A. Impact detection device
US20130312518A1 (en) * 2012-05-24 2013-11-28 Sagem Defense Securite Inertial unit having vibrating gyros mounted on a carousel, and an angle-measurement method
US9279682B2 (en) * 2012-05-24 2016-03-08 Sagem Defense Securite Inertial unit having vibrating gyros mounted on a carousel, and an angle-measurement method
US9032794B2 (en) 2012-08-09 2015-05-19 The Regents Of The University Of Michigan Pitcher training apparatus and method using a ball with an embedded inertial measurement unit
US9213889B2 (en) 2013-03-28 2015-12-15 The Regents Of The University Of Michigan Athlete speed prediction method using data from attached inertial measurement unit
CN113203580A (en) * 2021-05-10 2021-08-03 徐工集团工程机械有限公司 Engineering vehicle stability evaluation method, device and system and engineering vehicle
CN113203580B (en) * 2021-05-10 2024-03-29 江苏徐工国重实验室科技有限公司 Engineering vehicle stability evaluation method, device and system and engineering vehicle
CN114646440A (en) * 2022-03-16 2022-06-21 北京卫星环境工程研究所 Three-axis six-degree-of-freedom vibration control input and output coordinate transformation matrix construction method
CN114646440B (en) * 2022-03-16 2023-06-20 北京卫星环境工程研究所 Three-axis six-degree-of-freedom vibration control input/output coordinate transformation matrix construction method

Similar Documents

Publication Publication Date Title
US6128955A (en) Method for measuring 6 degrees of freedom motion and device therefor
US4908767A (en) Acceleration measuring system
US5383363A (en) Inertial measurement unit providing linear and angular outputs using only fixed linear accelerometer sensors
KR101123338B1 (en) A Movement Sensing Apparatus of an Object
US4611491A (en) Accelerometer system
US7463953B1 (en) Method for determining a tilt angle of a vehicle
JP2005315826A (en) Stress detection method for force sensor device with multi-axis sensor, and force sensor device using the same
Cismas et al. Crash detection using imu sensors
JP3763435B2 (en) Attitude angle detector
CN111504314B (en) IMU and rigid body pose fusion method, device, equipment and storage medium
US20190033341A1 (en) Mems-based three-axis acceleration sensor
US20100268508A1 (en) System and method for measuring tilt using lowest degrees of freedom of accelerometer
JP3334788B2 (en) Six-axis motion measurement method and device
Martin et al. Measuring the acceleration of a rigid body
US5686665A (en) Dynamic amount detector, dynamic amount detecting method, and camera with dynamic amount detector
JPH07225242A (en) Acceleration sensor, acceleration sensor system, vehicle equipped with acceleration sensor system, and other devices
JPH08178956A (en) Method and equipment for minimization of error in inertia sensor device
JPH08285952A (en) Seismometer
WO1996006328A1 (en) Three-dimensional measurement unit and position indicator
JPH0772165A (en) Rotation sensor using linear accelerometer
JPH07294240A (en) Position sensor
JPH0875442A (en) Simplified length measuring machine
JP2003139536A (en) Declinometer and azimuth measuring method
US5353226A (en) Coriolis indicator for situational awareness
McLean et al. A robotic joint sensor

Legal Events

Date Code Title Description
FPAY Fee payment

Year of fee payment: 4

REMI Maintenance fee reminder mailed
LAPS Lapse for failure to pay maintenance fees
STCH Information on status: patent discontinuation

Free format text: PATENT EXPIRED DUE TO NONPAYMENT OF MAINTENANCE FEES UNDER 37 CFR 1.362

FP Lapsed due to failure to pay maintenance fee

Effective date: 20081010