Nearly Finished Lib (needs testing)

testing is required to set sensible gains and delay times
Simplified FreeSixIMU library

Simplified Reinit method within FreeSix IMU lib.
Removed unused methods and instead of changing gyro input to quaternion
then back to angle, it simply uses the gyro input directly.