This application claims the priority benefit of Korean Patent Application No. 10-2011-0039478, filed on Apr. 27, 2011, in the Korean Intellectual Property Office, the disclosure of which is incorporated herein by reference.
1. Field
Example embodiments of the following description relate to a position estimation apparatus, and more particularly, to a position estimation apparatus used in a handheld-type terminal.
2. Description of the Related Art
Recently, use of portable terminals such as mobile communication terminals and personal digital assistants (PDAs) is rapidly expanding due to ease of portability. Due to such expansion, service providers and terminal manufacturers are competitively developing more convenient portable terminals to secure more users.
For example, the portable terminals provide various functions such as a phone book, a game console, a scheduler, a short message service (SMS), a multimedia message service (MMS), a cell broadcasting service, an Internet service, an e-mail service, a wakeup call, an mp3 player, and a digital camera, for example. Furthermore, an operational method of the portable terminals is not limited to a keypad or a touch screen employing buttons, but is also developed to respond to motions such as moving and tilting of the portable terminal.
In general, an algorithm for calculating a position includes a process of integrating angular velocities of a moving body, measured by a gyro sensor. The position calculation algorithm is useful only with a precision gyro sensor. Using a low-cost micro-electromechanical system (MEMS) gyro sensor, errors generated by bias and noise of the sensor are accumulated due to the integrating process, accordingly causing a positional error in a short time. To minimize this error, an additional sensor is used in conjunction with the gyro sensor for the position calculation using the MEMS gyro sensor. For example, an attitude reference system (ARS) method that calculates only a tilt angle using an acceleration sensor and a gyro sensor, and an attitude and heading reference system (AHRS) method that calculates a tilt angle and an azimuth angle may be used.
The conventional AHRS method calculates a position using an inertial measurement unit (IMU) constituted by a 3-axis accelerometer, a gyro sensor, and a geomagnetic sensor. However, in general, the AHRS method for calculating a position using gravity acceleration is susceptible to a dynamic motion. Since the acceleration measured by the acceleration sensor in the AHRS method is a sum of the gravity acceleration and motion acceleration, acceleration of an actual motion cannot be differentiated, which is why the AHRS method is susceptible to the dynamic motion.
The foregoing and/or other aspects are achieved by providing a position estimation apparatus including at least two acceleration sensors to measure 3-axis accelerations; a gyro sensor to measure 3-axis angular velocity; and a gravity acceleration compensation unit to calculate gravity acceleration from which a motion component is extracted, using the 3-axis accelerations measured by each of the acceleration sensors and the 3-axis angular velocity measured by the gyro sensor.
The motion component may be a rotational motion component based on a center of rotation.
The position estimation apparatus may further include a geomagnetic sensor to detect an azimuth angle; and a position estimation unit to estimate a position of the position estimation apparatus using the gravity acceleration, the 3-axis angular velocity, and the azimuth angle.
The position estimation apparatus may further include a gyration radius calculation unit to calculate a radius of gyration of the position estimation apparatus, using the 3-axis acceleration, measured by one of the at least two acceleration sensors, and the gravity acceleration.
The gyration radius calculation unit may estimate a motion trajectory of the position estimation apparatus using the radius of gyration and the 3-axis angular velocity.
At least two of the acceleration sensors may be disposed at different distances from a center of rotation of the position estimation apparatus.
At least two of the acceleration sensors may be disposed collinearly and at different distances corresponding to a center of rotation of the position estimation apparatus.
The gravity acceleration compensation unit may calculate the gravity acceleration from which the motion component is extracted from the 3-axis accelerations, using the 3-axis accelerations and the distances from the acceleration sensors to the center of rotation of the position estimation apparatus.
The foregoing and/or other aspects are achieved by providing a position estimation method including sensing motion by measuring 3-axis accelerations by at least two acceleration sensors and measuring 3-axis angular velocity by a gyro sensor; and calculating gravity acceleration from which a motion component is extracted, using the 3-axis accelerations measured by each of the acceleration sensors and the 3-axis angular velocity measured by the gyro sensor.
The motion component may be a rotational motion component based on a center of rotation.
The sensing may further include detecting an azimuth angle using a geomagnetic sensor; and estimating a position of the position estimation apparatus using the gravity acceleration, the 3-axis angular velocity, and the azimuth angle.
The position estimation method may further include calculating a radius of gyration of the position estimation apparatus, using the 3-axis acceleration measured by one of the acceleration sensors and the gravity acceleration.
The position estimation method may further include estimating a motion trajectory of the position estimation apparatus, using the radius of gyration and the 3-axis angular velocity.
At least two of the acceleration sensors may be disposed at different distances from a center of rotation of the position estimation apparatus.
At least two of the acceleration sensors may be disposed collinearly and at different distances corresponding to a center of rotation of the position estimation apparatus.
The calculating may calculate the gravity acceleration from which the motion component is extracted from the 3-axis accelerations, using the 3-axis accelerations and the distances from the acceleration sensors to the center of rotation of the position estimation apparatus.
Additional aspects, features, and/or advantages of example embodiments will be set forth in part in the description which follows and, in part, will be apparent from the description, or may be learned by practice of the disclosure.
When an acceleration sensor is used in measuring a tilt corresponding to gravity acceleration, an error may be generated by motion acceleration. When a position of an object in a rotational motion is estimated, the embodiments may increase accuracy of measuring a tilt corresponding to a gravity direction, by removing a rotational motion component from acceleration measured by at least two acceleration sensors, arranged at different distances from a center of rotation of a position estimation apparatus, and a gyro sensor.
These and/or other aspects and advantages will become apparent and more readily appreciated from the following description of the example embodiments, taken in conjunction with the accompanying drawings of which:
Reference will now be made in detail to example embodiments, examples of which are illustrated in the accompanying drawings, wherein like reference numerals refer to like elements throughout. Example embodiments are described below to explain the present disclosure by referring to the figures.
When a position estimation apparatus according to example embodiments is used in a handheld manner, a user generally performs a rotational motion made about a joint such as an elbow and a shoulder of the user. Therefore, acceleration measured by an acceleration sensor would include motion acceleration of a rotational motion component, in addition to gravity acceleration.
Example embodiments suggested hereinafter adopt at least two acceleration sensors to calculate gravity acceleration more accurately, by removing a rotational motion component from acceleration measured by the acceleration sensors, so that accurate position estimation is achieved.
Referring to
The first acceleration sensor 110 and the second acceleration sensor 120, being disposed at different distances from a center of rotation of the position estimation apparatus 100, each measure 3-axis acceleration.
According to a representative example of the arrangement of acceleration sensors, the first acceleration sensor 110 and the second acceleration sensor 120 may be disposed at different positions to be directed to the center of rotation of the position estimation apparatus 100. Here, the center of rotation may be an elbow or shoulder of the user because, when the user uses the position estimation apparatus 100 in a handheld manner, a motion of the user becomes a rotational motion made about a joint such as the elbow or shoulder.
Although
The gyro sensor 130 may measure 3-axis angular velocity indicating rotation about three axes of the position estimation apparatus 100. The geomagnetic sensor 140 may detect an azimuth angle of the position estimation apparatus 100 in consideration of a geomagnetic field. The sensor signal processing unit 150 may convert analog sensor signals obtained through the first acceleration sensor 110, the second acceleration sensor 120, the gyro sensor 130, and the geomagnetic sensor 140, into digital sensor signals for digital calculation. The sensor signal processing unit 150 may be configured as shown in
Referring to
The digital conversion unit 210 may convert analog sensor signals obtained in the form of voltage through the first acceleration sensor 110, the second acceleration sensor 120, the gyro sensor 130, and the geomagnetic sensor 140, into digital signals.
The calibration unit 220 calibrates the digital signals converted by the digital conversion unit 210 to reflect preset properties of the first acceleration sensor 110, the second acceleration sensor 120, the gyro sensor 130, and the geomagnetic sensor 140.
The preprocessing unit 230 may perform preprocessing related to the digital signals calibrated by the calibration unit 220, so that the calibrated digital signals may be read by the gravity acceleration compensation unit 160, the position estimation unit 170, and the gyration radius calculation unit 180.
The gravity acceleration compensation unit 160 calculates the gravity acceleration from which the motion component is extracted, using the 3-axis accelerations measured by the first acceleration sensor 110 and the second acceleration sensor 120, and the 3-axis angular velocity measured by the gyro sensor 130. Here, the motion component to be extracted may be a rotational motion component based on the center of rotation.
Calculation of the gravity acceleration by the gravity acceleration compensation unit 160 will be described in further detail with reference to
Referring to
The acceleration measured between the positions p1 and p2 is calculated by Equation 1 below.
ā
1
=
1+
First, the angular acceleration
ā
1−ā1=
Presuming that
[
A matrix [
Here, since the matrix [
Therefore, the angular acceleration
Next, the gravity acceleration may be calculated using Equations 7 to 16.
First, for convenience, terms related to the calculated angular acceleration and the measured angular velocity will be defined as shown in Equation 7 below.
D=([
Here, [
Application of Equation 7 to Equation 1 may result in Equation 9 below.
ā
1
=
1
ā
2
=
2 [Equation 9]
When calculating the position by the position estimation apparatus 100, the gravity acceleration
First, a vector product of measurements of the first acceleration sensor 110 and the second acceleration sensor 120 may be expressed by Equation 10 as follows.
Here, [
In addition, using D
[
Also, [D
Here, det D denotes a determinant calculation result of D and D−T denotes a transpose matrix of an inverse matrix of D.
Equation 10 may be rearranged using Equation 11 and Equation 13, as shown in Equation 14 below.
ā
1
×ā
2
=[
Here, when
[b×]
Accordingly, application of Equation 15 to Equation 14 may result in Equation 16 as follows.
−[(ā1−ā2)×]
In Equation 16, although [(ā1−ā2)×] is singular and therefore does not have an inverse matrix, ratio of magnitudes of the components of
The position estimation unit 170 may estimate the position of the position estimation apparatus 100, using the gravity acceleration calculated by the gravity acceleration compensation unit 160, the 3-axis angular velocity measured by the gyro sensor 130, and the azimuth angle measured by the geomagnetic sensor 140.
The position estimation using the compensated gravity acceleration and the measured angular velocity by the position estimation unit 170 may be performed in various methods. According to example embodiments as shown in
Referring to
The tilt calculation unit 310 may calculate a tilt of the position estimation apparatus 100 using the gravity acceleration calculated by the gravity acceleration compensation unit 160. The angular velocity integration unit 320 may integrate the 3-axis angular velocity received through the gyro sensor 130. The azimuth angle calculation unit 330 may check the azimuth angle received through the geomagnetic sensor 140. The Kalman filter 340 may output the estimated position by combining the tilt corresponding to the gravity acceleration, the position obtained through integration of the angular velocity, and the azimuth angle obtained by the geomagnetic sensor, through the Kalman filter algorithm.
The gyration radius calculation unit 180 may calculate a radius of gyration of the position estimation apparatus 100, using the 3-axis acceleration measured by one of the first acceleration sensor 110 and the second acceleration sensor 120, and the gravity acceleration calculated by the gravity acceleration compensation unit 160.
After the gyration radius calculation unit 180 calculates the angular acceleration and the gravity acceleration through the gravity acceleration compensation unit 160, unknown variables in Equation 9 are the radiuses of gyration
1
=D
−1(ā1−
The gyration radius calculation unit 180 may estimate a motion trajectory indicating a position to which the position estimation apparatus 100 is moved, using the calculated radius of gyration and the 3-axis angular velocity measured by the gyro sensor 130.
Hereinafter, a position estimation method using the acceleration sensors in the position estimation apparatus 100 will be described with reference to the accompanying drawings.
Referring to
In operation 520, the position estimation apparatus 100 may convert analog sensor signals obtained through the acceleration sensors, the gyro sensor, and the geomagnetic sensor, into digital sensor signals for digital calculation.
In addition, in operation 530, the position estimation apparatus 100 may calculate gravity acceleration from which a rotational motion component is extracted, using the 3-axis accelerations measured by the acceleration sensors and the 3-axis angular velocity measured by the gyro sensor.
Additionally, the position estimation apparatus 100 may estimate a position of the position estimation apparatus 100 using the gravity acceleration, the 3-axis angular velocity, and the azimuth angle, in operation 540.
The position estimation apparatus 100 may calculate the radius of gyration of the position estimation apparatus 100, using the 3-axis acceleration measured by at least one of the acceleration sensors, and the gravity acceleration calculated in operation 530.
Although example embodiments have been shown and described, it would be appreciated by those skilled in the art that changes may be made in these example embodiments without departing from the principles and spirit of the disclosure, the scope of which is defined in the claims and their equivalents.
| Number | Date | Country | Kind |
|---|---|---|---|
| 10-2011-0039478 | Apr 2011 | KR | national |