旋转矩阵与欧拉角的相互转换

2024-08-14 1377

版权

本文内容由阿里云实名注册用户自发贡献，版权归原作者所有，阿里云开发者社区不拥有其著作权，亦不承担相应法律责任。具体规则请查看《阿里云开发者社区用户服务协议》和《阿里云开发者社区知识产权保护指引》。如果您发现本社区中有涉嫌抄袭的内容，填写侵权投诉表单进行举报，一经查实，本社区将立刻删除涉嫌侵权内容。

简介： 旋转矩阵与欧拉角的相互转换

旋转矩阵与欧拉角的相互转换

1. 概述

欧拉角与旋转矩阵的相互转换，是图形计算中的常见问题。

2. 详论

2.1. 欧拉角的理解

表达旋转变换最简单的理解是三种旋转矩阵（绕X轴旋转矩阵，绕Y轴旋转矩阵以及绕Z轴旋转矩阵）级联。而欧拉角同样也有三种：航向角heading，俯仰角pitch和滚转角roll；其中，航向角heading有时也被称为偏航角yaw。三个欧拉角定义的矩阵级联也可以定义成旋转矩阵，这种旋转变换也叫做欧拉变换。

两者并没有绝对的对应的关系，但是绝大部分情况下，我们可以确定一个默认的视图方向：朝向负z轴，头部沿y轴定向，如下图所示：

想象一个飞机也位于上图的坐标系的默认视图，那么很显然可以看出一个对应关系：

航向角heading为绕Y轴旋转
俯仰角pitch为绕X轴旋转
滚转角roll为绕Z轴旋转

2.2. 欧拉角转旋转矩阵

如上节所述，确定欧拉角到底是绕哪一个轴旋转的关键是确定默认的视图方向。另一个需要确定的因素就是旋转的顺序。由于矩阵的乘法不满足交换律，那么矩阵级联的顺序不同，得到的旋转矩阵也不同。一种比较常用的旋转顺序是：

E(h,p,r)=Rz(r)Rx(p)Ry(h)E(ℎ,�,�)=R�(�)R�(�)R�(ℎ)

我们使用GLM（OpenGL Mathematics）库进行验证一下：

#include <iostream>
#include <glm/gtx/euler_angles.hpp>
using namespace std;
static void PrintMat(const glm::mat4& m)
{
  for (int i = 0; i < 4; i++)
  {
    for (int j = 0; j < 4; j++)
    {
      printf("%.9lf\t", m[i][j]);
    }
    printf("\n");
  }
}
int main()
{
  glm::mat4 rotY = glm::eulerAngleY(glm::radians(24.0f));
  glm::mat4 rotX = glm::eulerAngleX(glm::radians(65.0f));
  glm::mat4 rotZ = glm::eulerAngleZ(glm::radians(42.0f));
  glm::mat4 rotYXZ = rotY * rotX * rotZ;
  PrintMat(rotYXZ);
  cout << endl;
  glm::mat4 rotYXZ1 = glm::eulerAngleYXZ(glm::radians(24.0f), glm::radians(65.0f), glm::radians(42.0f));
  PrintMat(rotYXZ1);
  cout << endl;
  glm::mat4 rotYXZ2 = glm::yawPitchRoll(glm::radians(24.0f), glm::radians(65.0f), glm::radians(42.0f));
  PrintMat(rotYXZ2);
}

运行结果如下：

直接使用欧拉角旋转矩阵相乘，与eulerAngleYXZ()函数，以及yawPitchRoll()函数三者的矩阵结果是一致的。说明在GLM中欧拉角的定义以及旋转顺序，与本文论述的一致。

2.3. 旋转矩阵转欧拉角

已知绕X轴、Y轴以及Z轴旋转矩阵的公式以及它们的旋转顺序，可以很容易倒推旋转矩阵表达的欧拉角。当然也没有那么容易，因为有一些特殊情况必须处理。那么还是通过GLM进行实现：

#include <iostream>
#include <glm/gtx/euler_angles.hpp>
using namespace std;
static void PrintMat(const glm::mat4& m)
{
  for (int i = 0; i < 4; i++)
  {
    for (int j = 0; j < 4; j++)
    {
      printf("%.9lf\t", m[i][j]);
    }
    printf("\n");
  }
}
int main()
{
  glm::mat4 rotY = glm::eulerAngleY(glm::radians(24.0f));
  glm::mat4 rotX = glm::eulerAngleX(glm::radians(65.0f));
  glm::mat4 rotZ = glm::eulerAngleZ(glm::radians(42.0f));
    
  glm::mat4 rotYXZ1 = glm::eulerAngleYXZ(glm::radians(24.0f), glm::radians(65.0f), glm::radians(42.0f));
  PrintMat(rotYXZ1);
  cout << endl;
  float y = 0, x = 0, z = 0;
  glm::extractEulerAngleYXZ(rotYXZ1, y, x, z);
  cout << glm::degrees(y) << '\t' << glm::degrees(x) << '\t' << glm::degrees(z);
}