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

利用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
    评论

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值