AP_Math: fix up rotation test suite
AP_Math: change quaternion class to use const references where optimal
AP_Math: expand frame transformation test case for quaternions