You signed in with another tab or window. Reload to refresh your session.You signed out in another tab or window. Reload to refresh your session.You switched accounts on another tab or window. Reload to refresh your session.Dismiss alert
Copy file name to clipboardExpand all lines: README.md
+3-3Lines changed: 3 additions & 3 deletions
Display the source diff
Display the rich diff
Original file line number
Diff line number
Diff line change
@@ -1,4 +1,4 @@
1
-
# Heading estimate
1
+
# imuFilter
2
2
This library fuses the outputs of an inertial measurement unit (IMU) and stores the heading as a quaternion. It uses a _kalman-like_ filter to check the acceleration and see if it lies within a deviation from (0,0,1)g. If the acceleration is within this band, it will strongly correct the orientation. However, if the acceleration lies outside of this band, it will barely affect the orientation. To this end, the deviation from vertical is used to update the variance and kalman gain:
@@ -20,7 +20,7 @@ As the filter uses a quaternion to encode rotations, it's easy to perform coordi
20
20
Moreover, since a 6-axis IMU (gyro-accelerometer) cannot measure an absolute heading, a function is included to rotate the orientation about the vertical (yaw) axis. One can use vector operations to correct the heading with an additional sensor like a magnetometer.
21
21
22
22
# Velocity estimate
23
-
The library can also integrate acceleration to obtain velocity. This is accomplished by using a set of kalman-like filters like the one shown above. First, the acceleration is checked against a rest condition of (0,0,0)g, and any deviations from this state that lie within specified band are suppresed. This eliminates much of the bias in the acceleration due to gravity or miscalibration:
23
+
The library can integrate acceleration to obtain a short-term estimate of velocity. This is accomplished by using a set of kalman-like filters like the one shown above. First, the acceleration is checked against a rest condition of (0,0,0)g, and any deviations from this state that lie within specified uncertainty band are suppresed. This eliminates much of the bias due to gravity or miscalibration:
Afterwords, the deviation of the velocity (relative to a known target velocity) along with the variance of the acceleration, are used to determine the kalman gain of the velocity. This relationship causes small velocity deviations or small accelerations to reduce the gain, and the velocity estimate will be forced to match the known target velocity:
33
+
Afterwords, the deviation of the velocity (relative to a known target velocity) along with the variance of the acceleration are used to determine the kalman gain of the velocity. This relationship causes small velocity deviations or small accelerations to reduce the gain, and the velocity estimate is forced to match the known target velocity:
0 commit comments