小工具知识网

当前位置: 首页 > 行业知识 > 坐标变换基础-欧拉角&固定角与位姿矩阵的相互转换

行业知识

坐标变换基础-欧拉角&固定角与位姿矩阵的相互转换

2026-11-17 12:52:48 来源:互联网转载

概念定义

���间中一个坐标系相对于另一个坐标系的变换关系用新坐标系的三个坐标轴相对于原坐标系的方向矢量来确定,可用 矩阵来描述。用齐次矩阵(4x4)来统一描述刚体的位置和姿态:

其中,R便是描述姿态的旋转矩阵。

和沿着三个坐标轴的平移运动不一样,旋转矩阵显得很不直观,也繁琐。因此往往需要使用更简洁的方式来描述姿态变换。固定角与欧拉角便是最常规的两种。

欧拉角是用来唯一地确定定点转动刚体位置的三个一组独立角参量,由章动角θ、进动角ψ和自转角φ组成,为L.欧拉首先提出,故得名。

固定角与欧拉角的区别在于,在旋转变换的过程中,欧拉角指的是旋转是绕物体自身的坐标轴旋转。固定角指的是旋转绕世界坐标系的轴旋转。以下介绍两种常见的表达形式来具体分析

X-Y-Z固定角

如图所示,首先将目标坐标系{B}与参考坐标系{A}重合,将坐标系{B}先绕XA轴旋转γ度,再将坐标系{B}绕YA轴旋转β度,最后将坐标系{B}绕ZA轴旋转α度。最终得到新的坐标系{B}。

可以看到每次旋转都是绕着固定坐标系{A}的轴,所以才称为X-Y-Z固定角。

  • 欧拉角转换成旋转矩阵

    基于坐标系绕轴向量的旋转公式,由旋转顺序可直接推导:

    得:

    • 旋转矩阵转换成欧拉角

      旋转矩阵已知,求未知量为γ,β,α,由式

      相当用9个方程对3个未知量求解。经分析,通过对r11和r21对应两个等式求平方和再开根,可以求得cosβ,再由r31可以求得sinβ,即可解出β。

      在不考虑β=±90°的情况下,联立r11和r21对应两个等式可以求得α,联立r32和r33两个等式可求得γ,具体公式如下:

      考虑β=±90的特殊情况,α任意解都满足,一般取0。

      若β=90°,则:

      若β=-90°,则:

      matlab代码如下

      function coord_result = Tran_ZYX(pmatrix)% 矩阵pmatrix转换成Z-Y-X型的位姿值想x,y,z,w,p,rp_base = atan2(-pmatrix(3,1),sqrt(pmatrix(1,1)^2 + pmatrix(2,1)^2));if (abs(pmatrix - pi/2) 

上一篇:打开服务器错误怎么办?

下一篇:JS实现返回上一页功能的小技巧