转换矩阵、平移矩阵、旋转矩阵关系以及python实现旋转矩阵、四元数、欧拉角之间转换
文章目录
- 1. 转换矩阵、平移矩阵、旋转矩阵之间的关系
- 2. 缩放变换、平移变换和旋转变换
- 2. python实现旋转矩阵、四元数、欧拉角互相转化
由于在平时总是或多或少的遇到平移旋转的问题,每次都是现查资料,然后查了忘,忘了继续查,这次弄明白之后干脆写一篇文章,给人方便同时于己方便,后续如有扩充或变动也方便添加。
1. 转换矩阵、平移矩阵、旋转矩阵之间的关系
假设有两个向量a1=(x1,y1,z1)a_1 = (x_1, y_1, z_1)a1=(x1,y1,z1)和a2=(x2,y2,z2)a_2 = (x_2, y_2, z_2)a2=(x2,y2,z2),它们的转换关系为:
a1=R∗a2+Ta_1 = R * a_2 + T a1=R∗a2+T
这里RRR就是它的旋转矩阵
,TTT就是它的平移矩阵
。使用齐次方式表示如下:
(a11)=(RT01)∗(a21)\begin{pmatrix} a_1\\ 1 \end{pmatrix}= \begin{pmatrix} R&T\\ 0&1 \end{pmatrix}* \begin{pmatrix} a_2\\1 \end{pmatrix} (a11)=(R0T1)∗(a21)
使用元素值替换后,表示如下:
(x1y1z11)=(r11r12r13t1r21r22r23t2r31r32r33t30001)∗(x2y3z21)\begin{pmatrix} x_1\\y_1\\z_1\\1 \end{pmatrix}= \begin{pmatrix} r_{11}&r_{12}&r_{13}&t_{1}\\ r_{21}&r_{22}&r_{23}&t_{2}\\ r_{31}&r_{32}&r_{33}&t_{3}\\ 0&0&0&1 \end{pmatrix}* \begin{pmatrix} x_2\\y_3\\z_2\\1 \end{pmatrix} x1y1z11=r11r21r310r12r22r320r13r23r330t1t2t31∗x2y3z21
在仿射变换中的转换矩阵表示先线性变换再平移。在这里转换矩阵
表示如下:
转换矩阵=(r11r12r13t1r21r22r23t2r31r32r33t30001)转换矩阵= \begin{pmatrix} r_{11}&r_{12}&r_{13}&t_{1}\\ r_{21}&r_{22}&r_{23}&t_{2}\\ r_{31}&r_{32}&r_{33}&t_{3}\\ 0&0&0&1 \end{pmatrix} 转换矩阵=r11r21r310r12r22r320r13r23r330t1t2t31
平移矩阵
表示如下:
平移矩阵T=(t1t2t3)平移矩阵T=\begin{pmatrix} t_{1}\\ t_{2}\\ t_{3}\\ \end{pmatrix} 平移矩阵T=t1t2t3
旋转矩阵
表示如下:
旋转矩阵R=(r11r12r13r21r22r23r31r32r33)旋转矩阵R=\begin{pmatrix} r_{11}&r_{12}&r_{13}\\ r_{21}&r_{22}&r_{23}\\ r_{31}&r_{32}&r_{33} \end{pmatrix} 旋转矩阵R=r11r21r31r12r22r32r13r23r33
2. 缩放变换、平移变换和旋转变换
如果理解以上知识点之后,缩放变换、平移变换和旋转变换的特殊情况也迎刃而解。
- 缩放变换
缩放变换只是在尺度上进行改变
,所以它的变换形式如下:
- 平移变换
平移变换的时候,角度不发生改变,也就是旋转矩阵R为单位矩阵
,所以它的变换形式如下:
- 旋转变换
当空间内的物体绕着 x 轴,y 轴或者 z 轴旋转的时候,变换矩阵为:
对于一般性的旋转问题,可以用简单的旋转描述复杂的旋转。用 x 轴,y 轴和 z 轴上的旋转来定义旋转:
这三个角就被称作欧拉角(Euler angles)。
2. python实现旋转矩阵、四元数、欧拉角互相转化
在应用中,我们往往会遇到旋转矩阵、四元数和欧拉角之间的互相转换,在这里,我们只使用python代码来实现它们之间互相转换。
from scipy.spatial.transform import Rotation as Rdef quaternion2euler(quaternion):r = R.from_quat(quaternion)euler = r.as_euler('xyz', degrees=True)return eulerdef euler2quaternion(euler):r = R.from_euler('xyz', euler, degrees=True)quaternion = r.as_quat()return quaterniondef euler2rotation(euler):r = R.from_euler('xyz', euler, degrees=True)rotation_matrix = r.as_matrix()return rotation_matrixdef quaternion2rotation_matrix(quaternion):r = R.from_quat(quaternion)rotation_matrix = r.as_matrix()return rotation_matrixdef rotation_matrix2euler(rotation_matrix):r = R.from_matrix(rotation_matrix)euler = r.as_euler('xyz', degrees=True)return eulerdef rotation_matrix2quaternion(rotation_matrix):r = R.from_matrix(rotation_matrix)quaternion = r.as_quat()return quaternionif __name__ == '__main__':# 四元数=>欧拉角quaternion = [0.71934025092983234, -1.876085535681999e-06, -3.274841213980097e-08, -0.69465790385533299]euler = quaternion2euler(quaternion) # [-9.20000743e+01 1.52039496e-04 -1.52039496e-04]print(f'euler: {euler}')# 四元数=>旋转矩阵rotation_matrix = quaternion2rotation_matrix(quaternion)print(f'rotation_matrix: {rotation_matrix}')# 欧拉角=>四元数quaternion = euler2quaternion(euler)print(f'quaternion: {quaternion}') # [-7.19340251e-01 1.87608554e-06 3.27484122e-08 6.94657904e-01]# 欧拉角=>旋转矩阵rotation_matrix = euler2rotation(euler)print(f'rotation_matrix: {rotation_matrix}')# 旋转矩阵=>欧拉角euler = rotation_matrix2euler(rotation_matrix)print(f'euler: {euler}')# 旋转矩阵=>四元数quaternion = rotation_matrix2quaternion(rotation_matrix)print(f'quaternion: {quaternion}')
转换矩阵、平移矩阵、旋转矩阵关系以及python实现旋转矩阵、四元数、欧拉角之间转换相关推荐
- python中时间戳、字符串之间转换详解
[转载]python中时间戳.字符串之间转换详解 (2013-04-30 17:36:07) 转载▼ 标签: 转载 原文地址:python中时间戳.字符串之间转换详解作者:doris0920 1)秒数 ...
- python与excel的关系-使用python对excle和json互相转换的示例
python 版本:2.7 只是读取excel的话可以直接使用xlrd 1.excle to json 代码如下 # -*-coding:utf8 -*- import xlrd from colle ...
- matlab 欧拉角 方向余弦,旋转矩阵、欧拉角之间转换
学习过程中涉及欧拉角和旋转矩阵的转换,索性整理学习一下欧拉角四元数和旋转矩阵的概念以及matlab中的互相转换 本文摘自各大课本,博客,自己学习整理使用,侵删 MATLAB矩阵乘法从左到右依次相乘 用 ...
- 将py文件转换成html,(2条消息)自制 Python小工具 将markdown文件转换成Html文件
今天看到了一个Python库,名为markdown.瞬间就给了我一个灵感,那就是制作一个将markdown文件转换成html文件的小工具. 我的实验环境操作系统: Windows 7 64位 旗舰版 ...
- 矩阵运算------矩阵平移与伸缩
1)矩阵平移 矩阵平移实现简单,使物体移动到具体位置.这是模型坐标到世界坐标的第一步使用的矩阵 2)矩阵拉伸 伸缩矩阵是矩阵表现物体大小变换的矩阵.如果伸缩因子小于1,表现为物体缩小:如果大于1,则表 ...
- 【Unity3D 灵巧小知识点】☀️ | Unity 四元数、欧拉角 与 方向向量 之间转换
Unity 小科普 老规矩,先介绍一下 Unity 的科普小知识: Unity是 实时3D互动内容创作和运营平台 . 包括游戏开发.美术.建筑.汽车设计.影视在内的所有创作者,借助 Unity 将创意 ...
- Python 罗德里格矩阵的空间坐标转换——两组公共点求所属坐标系的旋转矩阵与平移矩阵
import numpy as np# 罗德里格矩阵模型,根据公共点计算旋转矩阵与平移矩阵 def RodriguesMatrixModel(src, dst):# 计算比例关系scale = np. ...
- 三维重建中旋转矩阵与平移矩阵思想误区(转载)
版权声明:本文为博主原创文章,未经博主允许不得转载. https://blog.csdn.net/weixin_34346607/article/details/52988221 三维重建中通常要解决 ...
- 内参矩阵、外参矩阵、旋转矩阵、平移矩阵、单应矩阵、本征矩阵、基础矩阵
自己在单目结构光系统.双单目结构光系统及双目相机系统学习的过程中接触到如标题所列的各种矩阵,总感觉理解不到位,现在特总结下,方便日后查阅及修正自己的理解. 自己已经总结了单目相机各坐标系的变换,链接如 ...
最新文章
- C++中一个class类对象占用多少内字节(7个例子,很清楚)
- php的基础知识(四)
- python用pywin32库来隐藏windows文件
- 公众号推荐:Python入门、统计学、推荐系统、机器学习、深度学习、数据分析...
- [ SAP ASAP ] SAP ASAP 方法论 对SAP项目文档的考核标准、 Documentation Principle
- Java Process getOutputStream()方法与示例
- Apizza-快如何进行API开发进度管理
- 用Python+PIL将多个jpg图像批量合并成一个pdf文件
- 计算机主板 华硕 游戏用,华硕Z390-A大师主板,带你畅享极致游戏体验-华硕主板bios设置...
- 晶振 负载电容 匹配电容
- emacs go-mode 设置tab宽度
- chrome必备插件
- Symbian OS 精要
- 动物棋制作(C语言)
- 计算机 无法 访问共享网络打印机,“无法连接到网络共享打印机”的常见原因和解决方法:...
- php下载pdf并保存图片大小,php根据URL下载图片、压缩包、pdf等远程文件到本地
- android 图片凸出
- 学会做arduino交通灯
- android gradle下载慢的解决方法
- 基于高光谱的无损检测技术