Orientation Tracking via Dynamic PID Correction and Sensor Fusion
Find Innovative SolutionsGenerate Solutions
Solution Overview
Problem
Portable electronic devices face challenges in accurately determining spatial orientation and position due to drift in gyroscope data and noise, as well as limitations in accelerometer and magnetometer signals, which lead to lag and inaccuracy in orientation tracking, especially during rapid rotational motions.
Innovation Solution
A feedback control mechanism, specifically a PID control mechanism, is employed to supplement gyroscope data with periodic corrections from accelerometers and magnetometers, adjusting filtering based on rotational speed to minimize lag and enhance accuracy, and entering a fast correction mode when gyroscope data is unavailable to quickly track orientation using accelerometers and magnetometers.
Engineering Contradictions & Design Principles
Engineering Contradiction Analysis
1Measurement precision
If accelerometer data is heavily low pass filtered to remove noise, then measurement precision is improved, but lag increases due to filtering
Solution Approach 1:
The patent applies dynamic filtering by adjusting the low pass filter cutoff frequency based on the device's rotational speed. When rotational speed is high, the cutoff frequency is increased to reduce lag. When rotational speed is low, the cutoff frequency is decreased to improve noise filtering. This dynamic adjustment resolves the contradiction between measurement precision and lag by adapting the filtering strength to the current motion conditions.
2Speed
If gyroscope data is used as primary source for orientation, then response speed is improved, but drift and data loss occur
Solution Approach 1:
The patent implements a feedback control mechanism where accelerometer and magnetometer data are used to generate correction factors that are applied to gyroscope-based orientation estimates. The system continuously monitors gyroscope data quality and switches to alternative sources when drift or data loss is detected. This feedback loop maintains response speed while correcting drift and filling data gaps, resolving the reliability issue.
Solution Approach 2:
The patent creates a composite orientation estimation system that combines data from multiple sensor types (gyroscope, accelerometer, magnetometer) with different characteristics. Each sensor type compensates for the weaknesses of others: gyroscopes provide fast response, accelerometers provide gravity reference, and magnetometers provide heading reference. This composite approach maintains response speed while improving overall reliability through sensor fusion.
3Speed
If proportional response is increased in fast correction mode, then response speed is improved, but orientation accuracy may deteriorate due to suppressed integral response
Solution Approach 1:
The patent implements periodic switching between normal correction mode and fast correction mode based on gyroscope data availability. In fast correction mode, the proportional response is temporarily increased and integral response suppressed for quick recovery. After gyroscope data becomes available again, the system transitions back to normal mode where both proportional and integral responses are active for accurate long-term orientation maintenance. This periodic switching resolves the contradiction by applying aggressive correction only when necessary.
Applied Scientific Principles
This section explains which scientific principles are used to turn an abstract innovation direction into a practical engineering solution.
Function Achieved in This Case
This approach provides rapid and accurate orientation tracking by leveraging the strengths of each sensor, reducing drift and noise, and minimizing lag, ensuring precise spatial orientation determination even during high-speed rotations.
Implementation Method 1
gyroscopes can be used for measuring angular velocity of a portable electronic device
Implementation Method 2
accelerometers can be used for measuring acceleration including gravity
Implementation Method 3
portable electronic devices also may be equipped with other types of sensors such as a magnetometer, for instance, which can be used as a compass
Data Source
AI summary
A method for determining an orientation of a portable or mobile electronic device includes determining an orientation of the device using at least a first inertial motion sensor (e.g., a gyroscope) with which the portable electronic device is equipped. A correction factor is provided to the orientation of the electronic device using a feedback control signal based on motion data obtained from at least a second inertial motion sensor (e.g. an accelerometer) to reduce drift in motion data obtained from the first inertial sensor. Responsive to a loss of valid motion data from the first inertial motion sensor, a rate at which the correction factor is provided to the orientation of the portable electronic device is increased.