Quaternion Error Functionality Established

Added quaternion error function to existing ArduPlane quaternion library
and code is now set up to convert current euler angles to quaternions
and then use that to generate a quaternion error, then convert back to
euler angle error for PID controllers