从旋转向量到欧拉角的六种计算方法

利用SolvePNP解出旋转向量,旋转向量通过罗德里格斯公式解出旋转矩阵,然后通过下面六种公式计算即可,欧拉角有十二种,六种是相对于自身参考系,六种是相对于惯性参考系,这里是相对于惯性参考系的
Point3f RecToEulerXZY(Mat &R){
double Z = asin(-1R.at(1,2));
double X = asin(R.at(3,2) / cos(Z));
double Y = asin(R.at(1,3) / cos(Z));
return Point3f(X/PI
180,Y/PI180,Z/PI180);
}
Point3f RecToEulerXYZ(Mat &R){
double Y = asin(1R.at(1,3));
double X = acos(R.at(3,3) / cos(Y));
double Z = asin(R.at(1,2) / (-1
cos(Y)));
return Point3f(X/PI180,Y/PI180,Z/PI180);
}
Point3f RecToEulerYXZ(Mat &R){
double X = asin(-1
R.at(2,3));
double Z = acos(R.at(2,2) / cos(X));
double Y = asin(R.at(3,1) / (1cos(X)));
return Point3f(X/PI
180,Y/PI180,Z/PI180);
}
Point3f RecToEulerYZX(Mat &R){
double Z = asin(1R.at(2,1));
double X = acos(R.at(2,2) / cos(Z));
double Y = asin(R.at(2,3) / (-1
cos(X)));
return Point3f(X/PI180,Y/PI180,Z/PI180);
}
Point3f RecToEulerZYX(Mat &R){
double Y = asin(-1
R.at(3,1));
double X = acos(R.at(3,3) / cos(Y));
double Z = acos(R.at(1,1) / (1cos(Y)));
return Point3f(X/PI
180,Y/PI180,Z/PI180);
}
Point3f RecToEulerZXY(Mat &R){
double X = asin(1R.at(3,2));
double Y = acos(R.at(3,3) / cos(X));
double Z = asin(R.at(1,2) / (-1
cos(X)));
return Point3f(X/PI180,Y/PI180,Z/PI*180);
}

  • 1
    点赞
  • 4
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
要通过旋转矩阵计算欧拉角,需要先了解欧拉角的定义和表示方法。 欧拉角是用三个角度来描述三维空间中的旋转,常用的欧拉角有三种表示方式:欧拉-角度表示(Euler-Angle),欧拉-轴向表示(Euler-Axis)和欧拉-四元数表示(Euler-Quaternion)。其中,欧拉-角度表示是最为常见的一种表示方式,也是最容易理解的一种方法。 欧拉-角度表示包括三个角度,分别表示绕三个坐标轴(X、Y、Z)旋转的角度。通常用符号(α,β,γ)表示,其中,α表示绕X轴旋转的角度,β表示绕Y轴旋转的角度,γ表示绕Z轴旋转的角度。 旋转矩阵是描述三维空间旋转的一种方式,它是一个3x3的矩阵,表示将一个向量绕三个坐标轴旋转后的结果。在坐标系中,旋转矩阵的每一列都表示旋转后的坐标轴方向。 现在,假设我们有一个旋转矩阵R,要求它的欧拉角(α,β,γ)。 首先,我们可以根据矩阵R的定义,求出它的第三列向量(R31,R32,R33),即绕Z轴旋转后的坐标轴方向。这个向量的长度为cos(β),因此,可以通过求arccos(R33)来求出β的值。 接下来,我们可以通过以下公式来求解α和γ的值: - 当R31>0时,α = arctan(R32/R31) - 当R31<0时,α = arctan(R32/R31) + π - 当R31=0且R32>0时,α = π/2 - 当R31=0且R32<0时,α = -π/2 - 当R31=0且R32=0时,α的值可以任意取 - 当R13>0时,γ = arctan(R23/R13) - 当R13<0时,γ = arctan(R23/R13) + π - 当R13=0且R23>0时,γ = π/2 - 当R13=0且R23<0时,γ = -π/2 - 当R13=0且R23=0时,γ的值可以任意取 最后,我们就可以得到旋转矩阵R对应的欧拉角(α,β,γ)了。 需要注意的是,由于欧拉角的定义和表示方法比较复杂,因此在实际应用中,建议使用四元数来描述旋转,更加方便和高效。

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值