功能:四元数转欧拉角

格式:SLAM_QToEuler(q)

q:为一个1*4或者4*1表示旋转的矩阵变量

说明:
1、函数执行完毕返回一个3*1的矩阵变量
2、如果返回的矩阵变量为[a,b,c]，则表示q代表的旋转矩阵，按右手坐标系，先沿着x轴旋转弧度a;然后在新坐标系下，沿着y轴旋转弧度b，最后在最新的坐标系下沿着z轴旋转弧度为c

例子:
v = [1,2,3];
q = {SLAM_VToQ<矩阵运算\SLAM_VToQ>}(v);
a = SLAM_VToEuler(q)//回车得到如下结果
a =
[ 1.06690166522919
 -0.76561174047876
 -2.87201768003401 ]