20140217 - Enable MARG and quaternion math.  Misc code cleanup.