SJSURoboticsTeam / urc-control-system-2023

Apache License 2.0
5 stars 0 forks source link

Accelerometer Orientation Error in Arm Homing #125

Open andrew-bork opened 8 months ago

andrew-bork commented 8 months ago

Using the accelerometers only is not accurate for homing because when the arm rotates to home, a centripetal force is measured by the accelerometer. This messes with the accelerometer's sense of "down" and its sensed orientation.

We can fix this by incorporating the gyroscope readings into the measured orientation. Using a complimentary filter, we can combine the acceleration and gyroscope measurements into a single, accurate orientation reading.

This will also be useful if we later use IMUs to sense the orientation of rovers and possibly suspension.