问题

在三维空间中，计算一个向量vvv（或点vvv）绕另一个向量uuu旋转θ\thetaθ角后的坐标。

方法

罗德里格旋转公式(Rodrigues’ Rotation Formula)：
v′=vcosθ+u×vsinθ+(u⋅v)u(1−cosθ)v' = v cos \theta + u \times v sin \theta + (u \cdot v) u ( 1 - cos \theta) v′=vcosθ+u×vsinθ+(u⋅v)u(1−cosθ)
公式推导可见旋转之二 - 三维空间中的旋转:罗德里格旋转公式

示例代码

下面的代码是计算点vvv绕向量uuu旋转360°之后的点集。

import numpy as np
import matplotlib.pyplot as plt
from mpl_toolkits.mplot3d import Axes3Ddef RodriguesRotate(v:np.ndarray,u:np.ndarray,theta:float)->np.ndarray:'''向量v绕向量u旋转角度θ,得到新的向量P_new罗德里格斯旋转公式:v' = vcosθ + (u×v)sinθ + (u·v)u(1-cosθ) args:v:向量,维度为(3,)u:作为旋转轴的向量,维度为(3,)theta:旋转角度θ,此处默认为角度值returns:v_new:旋转后得到的向量,维度为(3,)'''u = u/np.linalg.norm(u) # 计算单位向量sin_theta = np.sin(theta*np.pi/180)cos_theta = np.cos(theta*np.pi/180)v_new = v*cos_theta + np.cross(u,v)*sin_theta + np.dot(u,v)*u*(1-cos_theta)return v_newv = np.array([1.1,1.5,2])
u = np.array([1,2,3])
ax = plt.gca(projection='3d')
ax.set_xlim([0,3])
ax.set_ylim([0,3])
ax.set_zlim([0,3])
ax.quiver(0,0,0,u[0],u[1],u[2])
V = np.zeros([360,3])
V[0] = v
for theta in range(1,360):V[theta]= RodriguesRotate(v,u,theta)
ax.scatter(V[:,0],V[:,1],V[:,2],c='cyan')
plt.show()

结果

三维空间中向量的旋转相关推荐

三维空间中两次旋转等效为一次旋转的计算方法(四元数)
首先介绍一下四元数: 四元数是一种高阶复数,其形式如下: H = s p a n { 1 , i , j , k } \mathbb{H} = span\{1,i,j,k\} H=span{1,i,j ...
2d的公式_旋转之二 - 三维空间中的旋转:罗德里格旋转公式
接上篇: 复数与2D旋转先来推导三维空间中的常用旋转公式. 三维空间中的旋转如果绕着空间中的一个单位向量旋转,旋转我们采用右手坐标系: 可以把分解成平行于的向量和 : 绕旋转并不会造成 ...
求解三维空间中两向量之间的夹角
问题描述:已知三维空间中的三个点P1P_1P1,P2P_2P2和P3P_3P3,求向量P1P2→\overrightarrow{P_1P_2}P1P2和P1P3→\overrightarr ...
向量叉乘求三维空间中两直线(或线段)的交点
1.2D空间的直线相交在二维空间中,利用两个直线方程y = kx + b我们可以直接计算出交点,但是这种方法麻烦了些,并且套用到三维空间用公式就更麻烦了,接下来介绍的是如何利用向量叉乘求出直线交点. ...
游戏中 ----三维空间中的向量
三维空间中的向量: 1.向量相等: 几何中,有相同的方向跟长度的向量被规定为相等. 而代数上我们说有着相同的维数 ,而在各个方向上的 ...
[足式机器人]Part1 三维空间中的跳行Ch03——【Legged Robots that Balance 读书笔记】
本文仅供学习使用本文结合个人理解体会作者的思路,也从个人科研角度出发,部分翻译参考由:QQ群(2群legged robot that balance)提供,感谢他们为本文英文版翻译所做的贡献(但有些 ...
利用四元数表示空间向量的旋转及代码示例
1.四元数的定义四元数(Quaternion)是带有一个实部和三个虚部的一种扩展复数,其表达式如下: i,j,k之间的关系可以理解为相互正交的三个单位向量,于是四元数又可以表示为标量+向量的形式,即 ...
三维空间中视角位置和物体取向的确定
1.确定位置我们要在三维空间中确定一个物体,或者定位一个视角:如果物体是一个对称物体,即我们不需要确定他的姿态,我们有两种方式确定它的位置. 1.1世界坐标系世界坐标系是一个特殊的坐标系,它建立了 ...
微分几何笔记(4) —— 二维三维空间中曲线的曲率以及环绕数
本篇文章我们从一般化的 Rn\mathbb{R}^nRn 空间回到我们生活的 R2,R3\mathbb{R}^2,\mathbb{R}^3R2,R3空间,看看低维空间中的曲线有哪些性质,主要计算下在非 ...

三维空间中向量的旋转

问题

方法

示例代码

结果

三维空间中向量的旋转相关推荐

最新文章

热门文章