Mobile devices and methods for determining orientation information thereof

Patent metadata

Field	Value
Publication number	US-10247550-B2
Application number	US-201615366090-A
Country	US
Kind code	B2
Filing date	Dec 1, 2016
Priority date	Nov 17, 2016
Publication date	Apr 2, 2019
Grant date	Apr 2, 2019

Abstract

A mobile device including an acceleration sensor, a magneto sensor, a gyroscope sensor, and a processor is provided. The acceleration sensor, the magneto sensor, and the gyroscope sensor generate acceleration data, magnetic field data, and angular velocity data, respectively. The processor determines a pitch angle and a roll angle according to the acceleration data, determines a yaw angle according to the magnetic field data, and determines a quaternion according to the pitch angle, the roll angle, and the yaw angle. Also, the processor determines orientation information of the mobile device according to the quaternion and the angular velocity data, and adjusts the orientation information according to the acceleration data and the magnetic field data.

First claim

What is claimed is:

1. A mobile device, comprising:
an acceleration sensor, configured to generate acceleration data;
a magneto sensor, configured to generate magnetic field data;
a gyroscope sensor, configured to generate angular velocity data; and
a processor, configured to determine a pitch angle and a roll angle according to the acceleration data generated by the acceleration sensor, determine a yaw angle according to the magnetic field data generated by the magneto sensor, determine a quaternion according to the pitch angle, the roll angle, and the yaw angle, determine orientation information of the mobile device according to the quaternion and the angular velocity data generated by the gyroscope sensor, and adjust the orientation information according to the acceleration data generated by the acceleration sensor and the magnetic field data generated by the magneto sensor.

2. The mobile device as claimed in claim 1 , wherein the processor is further configured to determine a state transition matrix of an Extended Kalman Filter (EKF) according to the quaternion and the angular velocity data, and use the EKF to determine the orientation information according to the state transition matrix and the quaternion.

3. The mobile device as claimed in claim 2 , wherein the processor is further configured to use the EKF to adjust the orientation information according to the state transition matrix and the acceleration data, and use the EKF to adjust the orientation information according to the state transition matrix and the magnetic field data.

4. The mobile device as claimed in claim 1 , wherein the orientation information comprises an estimated quaternion.

5. The mobile device as claimed in claim 4 , wherein the processor is further configured to determine Euler angles corresponding to the estimated quaternion.

6. The mobile device as claimed in claim 1 , wherein the processor is further configured to use a North-East-Down (NED) coordinate system as a frame of reference for determining the pitch angle, the roll angle, and the yaw angle, and determine a change-of-coordinates matrix between the NED coordinate system and a body frame of the mobile device.

7. The mobile device as claimed in claim 1 , wherein the processor is further configured to perform vector normalization on the acceleration data, prior to determining the pitch angle and the roll angle.

8. The mobile device as claimed in claim 1 , wherein the processor is further configured to perform vector normalization on the quaternion, prior to determining the orientation information.

9. A method, executed by a processor of a mobile device to determine orientation information of the mobile device which comprises an acceleration sensor, a magneto sensor, and a gyroscope sensor, the method comprising:
determining a pitch angle and a roll angle according to acceleration data generated by the acceleration sensor;
determining a yaw angle according to magnetic field data generated by the magneto sensor;
determining a quaternion according to the pitch angle, the roll angle, and the yaw angle;
determining orientation information of the mobile device according to the quaternion and angular velocity data generated by the gyroscope sensor; and
adjusting the orientation information according to the acceleration data generated by the acceleration sensor and the magnetic field data generated by the magneto sensor.

10. The method as claimed in claim 9 , wherein the step of determining the orientation information further comprises:
determining a state transition matrix of an Extended Kalman Filter (EKF) according to the quaternion and the angular velocity data; and
using the EKF to determine the orientation information according to the state transition matrix and the quaternion.

11. The method as claimed in claim 10 , wherein the step of adjusting the orientation information further comprises:
using the EKF to adjust the orientation information according to the state transition matrix and the acceleration data; and
using the EKF to adjust the orientation information according to the state transition matrix and the magnetic field data.

12. The method as claimed in claim 9 , wherein the orientation information comprises an estimated quaternion.

13. The method as claimed in claim 12 , further comprising:
determining Euler angles corresponding to the estimated quaternion.

14. The method as claimed in claim 9 , further comprising:
using a North-East-Down (NED) coordinate system as a frame of reference for determining the pitch angle, the roll angle, and the yaw angle; and
determining a change-of-coordinates matrix between the NED coordinate system and a body frame of the mobile device.

15. The method as claimed in claim 9 , further comprising:
performing vector normalization on the acceleration data, prior to determining the pitch angle and the roll angle.

16. The method as claimed in claim 9 , further comprising:
performing vector normalization on the quaternion, prior to determining the orientation information.

Assignees

• Via Alliance Semiconductor Co Ltd

Inventors

• Lin Xia
• Wu Dongxing
• Gu Deming
• Mao Yang

Classifications

• G01B21/22 Primary

  for measuring angles or tapers; for testing the alignment of axes · CPC title

• G01C21/165

  combined with non-inertial navigation instruments · CPC title

• G01C21/1654 Primary

  with electromagnetic compass · CPC title