If you haven't already, take a look a the
nav6 Open Source IMU designed for FIRST robotics. It implements sophisticated inertial navigation algorithms onboard and is designed for easy integration onto a FRC robot. If there's any questions, you can email me with any questions directly at
scott@kauailabs.com.