Python动态演示旋转矩阵的作用详解
作者:微小冷 发布时间:2022-08-21 02:35:15
先新建一组散点充当坐标轴
为了比较直观地展示旋转过程,这里通过散点来新建三个坐标轴,通过对这三个坐标轴的转动,来直观地展现转动矩阵对坐标变换的影响。
import numpy as np
import matplotlib.pyplot as plt
def setAxis(N, axis=0):
xs = np.arange(N)
ys = np.zeros_like(xs)
zs = np.zeros_like(xs)
if axis==0 : return [xs, ys, zs]
elif axis==1 : return [ys, xs, zs]
else: return [ys, zs, xs]
def drawAxis(X,Y,Z):
ax = plt.subplot(projection='3d')
ax.scatter(*X, c='r')
ax.scatter(*Y, c='g')
ax.scatter(*Z, c='b')
plt.show()
X = setAxis(10, 0)
Y = setAxis(10, 1)
Z = setAxis(10, 2)
drawAxis(X, Y, Z)
效果为
旋转矩阵与初步演示
欧拉角是用来唯一地确定定点转动刚体位置的三个一组独立角参量,由章动角θ、进动角ψ和自转角φ组成,为L.欧拉首先提出,故得名。
为了尽快进入演示部分,故对原理的介绍从略,仅从二维平面上的旋转矩阵出发,做一个简单的推导,而三维旋转矩阵,至少在形式上与二维是雷同的。
假设坐标系中有一个向量 ( x , y ),其模长为,角度为
。若将其围绕坐标原点逆时针旋转 θ \theta θ,则其坐标变为
由于 ,则上式可以写为
写成矩阵形式即为
也就是说,在平面直角坐标系上,向量绕原点顺时针旋转 θ \theta θ,相当于左乘一个旋转矩阵。
推广到三维,为了限制 x y xy xy坐标平面上的旋转,要将其旋转中心从原点扩展为绕着 z z z轴旋转,从而三维旋转矩阵可推广为
同理可得到绕三个轴转动的旋转矩阵,为了书写方便,记,可列出下表。
下面用lambda
表达式来实现,用以描述单个轴的旋转过程。
import numpy as np
# 将角度转弧度后再求余弦
cos = lambda th : np.cos(np.deg2rad(th))
sin = lambda th : np.sin(np.deg2rad(th))
# 即 Rx(th) => Matrix
Rx = lambda th : np.array([
[1, 0, 0],
[0, cos(th), -sin(th)],
[0, sin(th), cos(th)]])
Ry = lambda th : np.array([
[cos(th), 0, sin(th)],
[0 , 1, 0],
[-sin(th), 0, cos(th)]
])
Rz = lambda th : np.array([
[cos(th) , sin(th), 0],
[-sin(th), cos(th), 0],
[0 , 0, 1]])
有了旋转矩阵,就可以旋转,接下来让坐标轴沿着三个轴分别旋转30°,其效果如下
代码如下
def drawAxis(X, Y, Z, fig, i):
ax = fig.add_subplot(1,3,i,projection='3d')
ax.plot(*X, c='r')
ax.plot(*Y, c='g')
ax.plot(*Z, c='b')
Xx, Yx, Zx = Rx(30) @ X, Rx(30) @ Y, Rx(30) @ Z
Xy, Yy, Zy = Ry(30) @ X, Ry(30) @ Y, Ry(30) @ Z
Xz, Yz, Zz = Rz(30) @ X, Rz(30) @ Y, Rz(30) @ Z
fig = plt.figure("rotate")
drawAxis(Xx, Yx, Zx, fig, 1)
drawAxis(Xy, Yy, Zy, fig, 2)
drawAxis(Xz, Yz, Zz, fig, 3)
plt.show()
转动次序对旋转的影响
由于旋转被建模成了矩阵,而众所周知矩阵乘法是不可交换的,也就是说,就算绕着三个坐标轴旋转相同的角度,也会因为转动次序不同而引发不同的结果。
XYZ = [X, Y, Z]
R_xyz = [Rz(30) @ Ry(30) @ Rx(30) @ R for R in XYZ]
R_zyx = [Rx(30) @ Ry(30) @ Rz(30) @ R for R in XYZ]
R_yxz = [Rz(30) @ Rx(30) @ Ry(30) @ R for R in XYZ]
fig = plt.figure("rotate")
drawAxis(*R_xyz, fig, 1)
drawAxis(*R_zyx, fig, 2)
drawAxis(*R_yxz, fig, 3)
plt.show()
得到下图
动态演示旋转过程
30°的转动之后,坐标轴变得面目全非,接下来要做的就是动态绘制这三个坐标轴的旋转过程
from numpy.random import rand
from matplotlib import animation
Rot = [Rx, Ry, Rz]
# 根据指定坐标轴顺序来以指定角度旋转向量
def rotVec(vec, axis, degs):
for i in range(len(axis)):
vec = Rot[axis[i]](degs[i]) @ vec
return vec
# 若x在[a,b]区间,则对a取模,若小于a置0,大于b为b-a
def truncMod(x, a, b):
if x < a : return 0
elif x >= b : return b-a
else : return x%(b-a)
# 三个坐标轴
XYZ = [setAxis(10,i) for i in range(3)]
fig = plt.figure(figsize=(5,5))
ax = fig.add_subplot(projection='3d')
ax.grid()
lines = [ax.plot([],[],[], '-', lw=0.5, c=c)[0]
for c in 'rgb']
def animate(n):
# 按照xyz顺序旋转
axis = [2,1,0]
degs = [truncMod(n, st, st + 30) for st in [0,30,60]]
newXYZ = [rotVec(x, axis, degs) for x in XYZ]
for i in range(3):
lines[i].set_data(newXYZ[i][0],newXYZ[i][1])
lines[i].set_3d_properties(newXYZ[i][2])
return lines
ani = animation.FuncAnimation(fig, animate,
range(90), interval=50, blit=True)
#plt.show()
ani.save("zyx.gif")
效果如下
x-y-z
z-y-x
来源:https://tinycool.blog.csdn.net/article/details/127729265
![](https://www.aspxhome.com/images/zang.png)
![](https://www.aspxhome.com/images/jiucuo.png)
猜你喜欢
- 网页采用了 UTF-8 编码格式,这本来没有问题,问题是外部 CSS 文件默认是 ANSI
- 示例一:直接编写AJAX 实现。 客户端: 代码如下:<!DOCTYPE html PUBLIC &qu
- 在开发过程中,有时遇到由于缓存问题导致页面不能及时更新,有时页面引入了不必需的样式脚本文件,有时由于文件太多,字节过大导致页面的性能缓慢,为
- SQL Server内存会不断增加当 SQL Server 数据库引擎在 Microsoft? Windows NT? 或 Windows?
- 前言一些公司内部的CMS系统存在某些内容让指定的用户有权限访问,这时候可以用django自带的权限管理进行限制,比较方便。缺点:django
- php mysql PDO 查询操作的实例详解<?php $dbh = new PDO('mysql:host=localho
- 实现一个AuditLog的功能,是B/S结构专案。 每个用户可以登录系统,在程序中操作数据(添加,更新和删除)需要实现记录操作跟踪。是谁添加
- Python慢的重要原因:1、python是动态性语言不是静态性语言在python程序执行的时候,编译器不知道变量的类型。2、python是
- 这篇分享几个在地址栏实现的Javascript有趣效果和应用。能在浏览器地址栏实现的效果太多了,字体放大、显示所有图片、显示Cookie等等
- EXISTS该函数返回集合中第一个元素的索引,如果集合为空,返回NULLNULLNULLCollection.EXISTS(index)CO
- 一、多线程同步由于CPython的python解释器在单线程模式下执行,所以导致python的多线程在很多的时候并不能很好地发挥多核cpu的
- 在近几年Python的呼声越来越高,很多刚开始起步想要学习编程的朋友都会犹豫要不要选择学习Python,毕竟作为人工智能时代的首选语言这个诱
- 本文实例讲述了PHP实现的AES加密、解密封装类与用法。分享给大家供大家参考,具体如下:<?php/** * Class AES *
- 引言我们经常听到"因为GIL的存在,python的多线程不能利用多核CPU",现在我们暂且不提GIL,python能不能
- asp连接sql 第一种写法: 代码如下: MM_conn_STRING = "Driver={SQL Server};serv
- Module Tabs(也称选项卡,后文中简称Tab,以便更符合中国设计师的日常叫法) 是一个常见的交互元素——将不同的内容重叠放置在某一布
- pyautogui是一个可以控制鼠标和键盘的python库,类似的还有pywin32。pyautogui的安装pip3 install py
- 不知道大家有没发现DWMX中有一个和FW差不多的制作弹出菜单功能?这个功能允许用文字和图片做为主菜单,如果用文字的话要先做虚拟链接。下面简单
- golang 原生 http 库已经可以很方便地实现一个 http server 了,但对于复杂的 web 服务来说,路由解析,请求参数解析
- 一直以来,每次调用Ajax方法都需要创建一次 Microsoft.XMLHTTP 对象,今天在使用Ajax技术做一个类似聊天室的