3D Math Keynote 2
【3D Math Keynote 2】
1、方向(diretion),指的是前方朝向。方位(orientation),指的是head、pitch、roll。
2、欧拉角的缺点:
1)给定方位的表达式不惟一。
例如,pitch 135 = heading180 + pitch 45 + bank 180。
通过将 heading、bank 限制在 +180~-180度,pitch限制在+90~-90度即可解决不惟一的问题。
2)两个角度间插值非常困难。
3、复数的共轭
复数的模。
4、复数集存在于一个2D平面上,可以认为这个平面有2个轴:实轴、虚轴。
四元数有3个虚部,i、j、k。
绕向量 n 旋转 0 度的四元数:
q与-q代表的实际角位移是相同的,将0 加上360度,不会改变q的角位移,但q的四个分量都变负了。所以任意角位移有2种四元数的表示法。
四元数也有模。
5、四元数的共轭:
四元数的逆:
当 |q| 为1时,四元数的共轭,就是四元数的逆。
单位四元数:[1, 0]
四元数逆意味着向相反的方向旋转相同的角度。
6、四元数乘法。
四元数乘法满足结合律,不满足交换律。
四元数叉乘的模等于模的积:
四元数逆的性质:
7、四元数旋转公式:
下例,先执行a旋转,再执行b旋转:
8、四元数点乘。结果是一个标量。
9、四元数的对数。引入变量 alpha = 0/2
指数公式为:
9.1、四元数求幂。我们看看它的数学定义。
结合9中的公式,上式可以推导为 exp(t[0 alpha*n]),也就是 q^t次方,其实是 alpha 乘以了t。所以q^t实际上是 [cos(t*alpha) n.sin(t*alpha)]。
下述代码使用上述原理,计算四元数 q 的 t 次方的值。原理是让角度 alpha * t。
上面的 if 是用于避免单位四元数[1 0]的情况,单位四元数放大 t 倍,还是单位四元数。
10、slerp 避免了欧拉角插值的所有问题。四元数插值的理论:
旋转插值图解:
由相似三角形原理,可以求出 k0、k1。
所以 V(t) 可以表示为:
扩展到四元数即为:
slerp 的完整代码如下:
上述实现用了一个书上未证明的公式,四元数的点乘等于夹角的 cos。
11、squard 是四元数的样条插值。需要引入控制点:
可以看到,Si的计算需要引用 qi-1、qi、qi+1。所以在计算转变时,实际需要四个 q点。
样条插值轨迹为:
12、从欧拉角到矩阵。
从惯性坐标系到物体坐标系非常容易,将3个轴轴的旋转矩阵相乘即可。
而从物体坐标系到惯性坐标系,取上面矩阵的转置矩阵即可。
13、从矩阵到欧拉角
上面求解出了 pitch,也就推出了 cosp 的值。从而根据 m13、m33 可以推出 sinh、cosh 的的值,然后使用 atan2 即可计算出 h。
用同样的方式,可以用m21、m22解得 bank。
若 cosp 为0,则可推出 p 是+/- 90,b 为0。从而可以使用下面的值化简公式:
通过 m11、m31 可计算出h。
14、实现从矩阵解出欧拉角的算法。
// 设矩阵保存在下面这些变量中
float m11, m12, m13;
float m21,m22,m23;
float m31,m32,m33; // 以弧度形式计算欧拉角并存在以下变量中
float h,p,b; // 从m23计算pitch, 小心 asin() 的域错误,因浮点计算我们允许一定的误差
float sp = -m23;
if (sp <= -1.0f){
p = -1.570796f; // -pi/2
}else if (sp >= 1.0){
p = 1.570796; // pi/2
} else {
p = asign(sp);
} // 检查万象锁的情况,允许一些误差
if (sp > 0.9999f){
// 向正上或正下看
// 将 bank 置零,赋值给 heading
b = 0.0f;
h = atan2(-m32, m11);
} else {
// 通过 m12 和 m33 计算heading
h = atan2(m12, m33);
b = atan2(m21, m22);
}
15、从四元数转换到矩阵。
绕任意轴的旋转矩阵:
绕任意轴旋转的四元数:
我们需要把每一个m推导成为 w,x,y,z 的形式,以m11为例。
使用 cos 倍角公式:
最后展开化简可得:
其他m求法的就不举例了,是类似的方法。下面是最终答案,从四元数构造出的完整旋转矩阵:
16、从矩阵转换到四元数。
从直接利用公式 10.23,首先检查对角线元素。
可以用有类似的方法求得其他三个元素:
因为平方根的结果总是正。另一个技术是检查对称位置上的元素和。
首先用第一种方法计算出 w,x,y,z 其中一个的值,然后再用第二种方法,得出另外三个数值的值,即可避免所有元素均为正的问题。
下面是算法实现:
// 输入矩阵
float m11, m12, m13;
float m21, m22, m23;
float m31, m32, m33; // 输出四元数
float w, x, y, z; // 探测 w, x, y, z 中的最大绝对值
float fourWSquaredMinus1 = m11 + m22 +m33;
float fourXSquaredMinus1 = m11 - m22 - m33;
float fourYSquaredMinus1 = m22-m11-m33;
float fourZSquaredMinus1 = m33 - m11 -m33; int biggestIndex = ;
float fourBiggestSquaredMinus1 = fourWSquaredMinus1; if (fourXSquaredMinus1 > fourBiggestSquaredMinus1){
fourBiggestSquaredMinus1 = fourXSquaredMinus1;
biggestIndex = ;
} if (fourYSquaredMinus1 > fourBiggestSquaredMinus1){
fourBiggestSquaredMinus1 = fourYSquaredMinus1;
biggestIndex = ;
} if (fourZSquaredMinus1 > fourBiggestSquaredMinus1){
fourBiggestSquaredMinus1 = fourZSquaredMinus1;
biggestIndex = ;
} // 计算平方根和除法
float biggestVal = sqrt(fourBiggestSquaredMinus1 + 1.0f) * 0.5f;
float mult = 0.25f / biggestVal; // 计算四元数的值
switch(biggestIndex){
case :
w = biggestVal;
x = (m23-m32)*mult;
y = (m31-m13)*mult;
z = (m12 - m21) * mult;
break;
case :
x = biggestVal;
w = (m23-m32)*mult;
y = (m12+m21)*mult;
z = (m31+m12)*mult;
break;
case :
y = biggestVal;
w = (m31 - m13) * mult;
x = (m12 + m21) * mult;
z = (m23 + m32) * mult;
break;
case :
z = biggestVal;
w = (m12 - m21) * mult;
x = (m31 + m13) * mult;
y = (m23 + m32) * mult;
break;
}
17、从欧拉角转换到四元数。
先将三个轴的旋转分别转换为四元数,再将这三个四元数连接成一个四元数。下面是分别旋转的四元数:
将其连接起来即可得到结果。
18、从四元转换到欧拉角
我们已经知道从四元数到矩阵,也知道从矩阵到欧拉角。下面是从矩阵求欧拉角:
再下面是四元数求矩阵:
将图一中的 m 全部替换为 wxyz,即可得四元数到欧拉角的推导公式。
// 使用全局变量保存输入输出
float w,x,y,z;
float h,p,b; // 计算 si(pitch)
float sp = -2.0f * (y*z + w*x); // 检查万向锁,允许有一定误差
if (fabs(sp)>0.9999f){
// 向正上或正下看
p = 1.570796f * sp;
// 计算 heading, bank 置零
h = atan2(-x*z - w*y, 0.5f - y*y - z*z);
b = 0.0f;
}else{
// 计算角度
p = asin(sp);
h = atan2(x*z - w*y, 0.5f - x*x - y*y);
b = atan2(x*y - w*z, 0.5f - x*x, -z*z);
}
19、
20、
3D Math Keynote 2的更多相关文章
- 3D Math Keynote 4
[3D Math Keynote 4] 1.三角带. 合并三角带能够提升渲染效率. 三角扇. 2.边缩坍,将边缩减为顶点 . 网格消减,使用边缩坍,可以实现渐进式网络. 3.下图左边是面拆分.右边是焊 ...
- 3D Math Keynote 3
[3D Math Keynote 3] 1.球的表面积 Surface.球的体积 Volumn: 2.当物体旋转后,如果通过变换后的旧AABB来顶点来计算新的AABB顶点,则生成的新AABB可能比实际 ...
- 3D Math Keynote
[3DMathKeynote] 1.常用公式. 1)(A*B)^T = B^T*A^T. 2)(A*B)^-1 = B^-1*A^-1. 3)|A*B| = |A|*|B|. 4)|M^T|=|M ...
- 《3D Math Primer for Graphics and Game Development》读书笔记2
<3D Math Primer for Graphics and Game Development>读书笔记2 上一篇得到了"矩阵等价于变换后的基向量"这一结论. 本篇 ...
- 《3D Math Primer for Graphics and Game Development》读书笔记1
<3D Math Primer for Graphics and Game Development>读书笔记1 本文是<3D Math Primer for Graphics and ...
- 3D Math Library的姿势
http://www.opentk.com/doc/math http://www.gamedev.net/topic/484756-fast-vector-math-library-for-net/ ...
- 3D math primer for graphics and game development
三角网格(Triangle Mesh) 最简单的情形,多边形网格不过是一个多边形列表:三角网格就是全部由三角形组成的多边形网格.多边形和三角网格在图形学和建模中广泛使用,用来模拟复杂物体的表面,如建筑 ...
- 3D数学基础 KeyNote 1
[计算几何复习要点] 1.向量加法的几何含意: a+b的释意为:a的尾连上b的头,新建一条从a的尾指向b的头的向量. 2.向量减法的几何含意: a-b的释意为:尾部相连,新建一个从b的头指向a的头的向 ...
- 3D数学学习笔记——笛卡尔坐标系
本系列文章由birdlove1987编写.转载请注明出处. 文章链接: http://blog.csdn.net/zhurui_idea/article/details/24601215 1.3D数学 ...
随机推荐
- 申请Let's Encrypt永久免费SSL证书
Let's Encrypt简介 Let's Encrypt作为一个公共且免费SSL的项目逐渐被广大用户传播和使用,是由Mozilla.Cisco.Akamai.IdenTrust.EFF等组织人员发起 ...
- Android memory dump
1.读取指定pid和内存地址的字符: #include <stdlib.h> #include <stdio.h> #include <string.h> #inc ...
- windows下 go安装qt绑定
1.下载安装QT 离线版QT地址: https://download.qt.io/official_releases/qt/5.11/5.11.1/qt-opensource-windows-x86 ...
- 'pip' 不是内部或外部命令,也不是可运行的程序 或批处理文件。
之前python2.7是没有pip的,需要安装python3.6 以上. 但是安装3.6版本后,还是一样.官网提示需要执行以下命令:python -m ensurepip --default-pip ...
- web页面性能
一.资源压缩合并,减少HTTP请求 二.非核心代码异步加载 1.异步加载的方式 动态脚本加载 defer async 2.异步加载的区别 (1)defer是在HTML解析完之后才会执行,如果是多个,按 ...
- Kafka安装及开启SASL_PLAINTEXT认证(用户名和密码认证)
前些日子要封装一个kafka的客户端驱动,配置了下kafka环境,发现配置复杂度完爆rabbitmq很多倍啊,而且发布订阅模式使用起来也很麻烦,可能就胜在分布式了吧. kafka需要java环境,自行 ...
- ESP32 做Web服务器 http Server步骤
资料不多.多是国外网站的. 百度搜基本出来的是这个网站https://www.dfrobot.com/blog-922.html 出来的代码是: #include <WiFi.h>#inc ...
- 用SVG做background image
1 用utf8格式, 需要 双引号“”替换为单引号,而且采用url encode编码,例如# 替换为 %23, body { background-image: url("data:imag ...
- Java高级框架-----Spring(一)
一: 1. Spring几大核心功能: IOC/DI 控制反转/依赖注入 AOP 面向切面编程 声明式事务 2. Spring 框架的的runtime 2.1 test:Spring提供测试功能 2. ...
- C#将时间转化自定义类型格式,C#获取时间间隔
C# string.Format格式化日期: DateTime dt = ,,,,,,); string.Format("{0:y yy yyy yyyy}",dt); //17 ...