Merge pull request #499 from ey6es/gyroquat

Converted gyro rotation computations to use quaternions, fixed coordinates and increased rate of convergence to current gravity.