Hello,
Our system is unstable when we implement a normal PID controller. In order to have two stable poles, our system requires a discrete PID controller. Unfortunately, Arduino's PID library does not support modifications to the compensator formula. The programs we have coded thus far are all in Arduino IDE, our sensor (9-DOF Adafruit sensor) can easily be used in Arduino.
Link to sensor calibration:
https://learn.adafruit.com/nxp-precision-9dof-breakout/arduino-code