Changed the freq and Kp gain on the AHRS code. Also added informational comments
Merge branch 'FreeIMU' of github.com:Susurrus/MPU60xx into FreeIMU