刚体变换
定义
一个映射g:R3→R3\R^3 \to \R^3R3→R3如果满足一下两个特性,则是刚体变换
1. 长度保持不变:∥g(p)−g(q)=∥p−q∥\Vert g(p)-g(q)=\Vert p-q\Vert∥g(p)−g(q)=∥p−q∥, 所有p,q∈R3p,q\in\R^3p,q∈R3
2. 叉乘保持不变:g∗(v×w)=g∗(v)×g∗(w)g_*(v×w)=g_*(v)×g_*(w)g∗(v×w)=g∗(v)×g∗(w),所有向量v,w∈R3v,w\in\R^3v,w∈R3
旋转矩阵
A坐标系
XA=[1 0]TX_A=[1\ 0]^TXA=[1 0]T
YA=[0 1]TY_A =[0\ 1]^TYA=[0 1]T
在A坐标系下的B坐标系
XB=cosθ∥XA∥XA+sinθ∥XA∥YA=[cosθ 0 0]T+[0 sinθ 0]T=[cosθ sinθ 0]TX_B=cos\theta \|X_A\|X_A+sin\theta\|X_A\| Y_A=[cos\theta \ 0 \ 0]^T+[0\ sin\theta\ 0]^T=[cos\theta \ sin\theta \ 0]^TXB=cosθ∥XA∥XA+sinθ∥XA∥YA=[cosθ 0 0]