wpilibsuite / xrp-wpilib-firmware

6 stars 7 forks source link

Use MadgwickAHRS #13

Closed zhiquanyeo closed 10 months ago

zhiquanyeo commented 10 months ago

This PR uses the Madgwick filter to implement an AHRS (Attitude and Heading Reference System) and return the filtered RPY values instead of raw gyro angles. Combined with the gyro calibration in #10, this provides a more stable angle reading.

Fixes #9