AP_Math: added quaternion.from_rotation_matrix()
AP_Math: added tests for quaternion to/from rotation matrix
AP_NavEKF: initialise quaternion from rotation matrix