点、直线、平面是几何学中最基本的元素。如何表征它们,进而描述其运动,是不同几何理论研究的基础。
本章为全书后续各章提供数学基础——从三维向量与矩阵出发,经线几何过渡到旋量与旋量系。
1. 向量
1.1 点的坐标表示
空间直角坐标系中,点 P P P 的位置用坐标原点指向该点的向量 P \boldsymbol{P} P 表示:
P = P x i + P y j + P z k \boldsymbol{P} = P_x \boldsymbol{i} + P_y \boldsymbol{j} + P_z \boldsymbol{k} P = P x i + P y j + P z k
其中 i \boldsymbol{i} i 、j \boldsymbol{j} j 、k \boldsymbol{k} k 分别为平行于 x x x 、y y y 、z z z 轴的单位向量;P x P_x P x 、P y P_y P y 、P z P_z P z
为向量在各轴方向的投影。
写成列向量形式:
P = [ P x P y P z ] \boldsymbol{P} = \begin{bmatrix} P_x \\ P_y \\ P_z \end{bmatrix} P = P x P y P z
1.2 加法与数乘
向量是既有大小又有方向的量。n n n 维向量是 n n n 个有序数组成的数组,写成一行称行向量
a T = ( a 1 , a 2 , … , a n ) \boldsymbol{a}^{\mathrm{T}} = (a_1, a_2, \ldots, a_n) a T = ( a 1 , a 2 , … , a n ) ,写成一列称列向量 。
两三维向量 u = u x i + u y j + u z k \boldsymbol{u} = u_x \boldsymbol{i} + u_y \boldsymbol{j} + u_z \boldsymbol{k} u = u x i + u y j + u z k
和 v = v x i + v y j + v z k \boldsymbol{v} = v_x \boldsymbol{i} + v_y \boldsymbol{j} + v_z \boldsymbol{k} v = v x i + v y j + v z k 的加减法:
u ± v = ( u x ± v x ) i + ( u y ± v y ) j + ( u z ± v z ) k \boldsymbol{u} \pm \boldsymbol{v} = (u_x \pm v_x)\boldsymbol{i} + (u_y \pm v_y)\boldsymbol{j} + (u_z \pm v_z)\boldsymbol{k} u ± v = ( u x ± v x ) i + ( u y ± v y ) j + ( u z ± v z ) k
加减法满足封闭性,遵循平行四边形或三角形法则。
1.3 点积
向量的点积(内积):u ⋅ v = u x v x + u y v y + u z v z \boldsymbol{u} \cdot \boldsymbol{v} = u_x v_x + u_y v_y + u_z v_z u ⋅ v = u x v x + u y v y + u z v z ,满足交换律。
几何意义:u ⋅ v = ∥ u ∥ ∥ v ∥ cos θ \boldsymbol{u} \cdot \boldsymbol{v} = \|\boldsymbol{u}\| \|\boldsymbol{v}\| \cos\theta u ⋅ v = ∥ u ∥∥ v ∥ cos θ
,其中 ∥ u ∥ = u x 2 + u y 2 + u z 2 \|\boldsymbol{u}\| = \sqrt{u_x^2+u_y^2+u_z^2} ∥ u ∥ = u x 2 + u y 2 + u z 2 为向量的范数(模)。
特例 表达式 意义 v \boldsymbol{v} v 为单位向量(如 i \boldsymbol{i} i )u ⋅ i = ∥ u ∥ cos θ \boldsymbol{u} \cdot \boldsymbol{i} = \|\boldsymbol{u}\| \cos\theta u ⋅ i = ∥ u ∥ cos θ u \boldsymbol{u} u 在 x x x 轴上的投影两者均为单位向量 i ⋅ j = cos 90 ∘ = 0 \boldsymbol{i} \cdot \boldsymbol{j} = \cos 90^\circ = 0 i ⋅ j = cos 9 0 ∘ = 0 方向余弦,正交时点积为零
1.4 叉积
两向量的叉积生成一个新向量,垂直于两向量张成的平面,方向符合右手定则:
u × v = ∣ i j k u x u y u z v x v y v z ∣ = ( u y v z − u z v y ) i + ( u z v x − u x v z ) j + ( u x v y − u y v x ) k \boldsymbol{u} \times \boldsymbol{v} =\begin{vmatrix}\boldsymbol{i} & \boldsymbol{j} & \boldsymbol{k} \\u_x & u_y & u_z \\v_x & v_y & v_z\end{vmatrix}= (u_y v_z - u_z v_y)\boldsymbol{i} + (u_z v_x - u_x v_z)\boldsymbol{j} + (u_x v_y - u_y v_x)\boldsymbol{k} u × v = i u x v x j u y v y k u z v z = ( u y v z − u z v y ) i + ( u z v x − u x v z ) j + ( u x v y − u y v x ) k
几何意义:∥ u × v ∥ = ∥ u ∥ ∥ v ∥ sin θ \|\boldsymbol{u} \times \boldsymbol{v}\| = \|\boldsymbol{u}\| \|\boldsymbol{v}\| \sin\theta ∥ u × v ∥ = ∥ u ∥∥ v ∥ sin θ ,等于两向量围成的平行四边形面积。
叉积可借助反对称矩阵 [ u ] [\boldsymbol{u}] [ u ] 表达为矩阵乘法:
[ u ] = [ 0 − u z u y u z 0 − u x − u y u x 0 ] , u × v = [ u ] v [\boldsymbol{u}] =\begin{bmatrix}0 & -u_z & u_y \\u_z & 0 & -u_x \\-u_y & u_x & 0\end{bmatrix},\quad \boldsymbol{u} \times \boldsymbol{v} = [\boldsymbol{u}]\boldsymbol{v} [ u ] = 0 u z − u y − u z 0 u x u y − u x 0 , u × v = [ u ] v
运动学中的关键关系:角速度矢量与位置矢量叉积生成线速度矢量——v = ω × r \boldsymbol{v} = \boldsymbol{\omega} \times \boldsymbol{r} v = ω × r 。
运算律总结:
运算 交换律 结合律 分配律 点积 u ⋅ v = v ⋅ u \boldsymbol{u} \cdot \boldsymbol{v} = \boldsymbol{v} \cdot \boldsymbol{u} u ⋅ v = v ⋅ u — ✓ 叉积 u × v = − v × u \boldsymbol{u} \times \boldsymbol{v} = -\boldsymbol{v} \times \boldsymbol{u} u × v = − v × u ✗ ✓
常用叉积公式:
公式 说明 u × u = 0 \boldsymbol{u} \times \boldsymbol{u} = \boldsymbol{0} u × u = 0 自叉为零 u × ( v × w ) = ( u ⋅ w ) v − ( u ⋅ v ) w \boldsymbol{u} \times (\boldsymbol{v} \times \boldsymbol{w}) = (\boldsymbol{u} \cdot \boldsymbol{w})\boldsymbol{v} - (\boldsymbol{u} \cdot \boldsymbol{v})\boldsymbol{w} u × ( v × w ) = ( u ⋅ w ) v − ( u ⋅ v ) w 三重叉积(左展开) ( u × v ) × w = ( u ⋅ w ) v − ( v ⋅ w ) u (\boldsymbol{u} \times \boldsymbol{v}) \times \boldsymbol{w} = (\boldsymbol{u} \cdot \boldsymbol{w})\boldsymbol{v} - (\boldsymbol{v} \cdot \boldsymbol{w})\boldsymbol{u} ( u × v ) × w = ( u ⋅ w ) v − ( v ⋅ w ) u 三重叉积(右展开) ∥ u × v ∥ 2 = ∥ u ∥ 2 ∥ v ∥ 2 − ( u ⋅ v ) 2 \|\boldsymbol{u} \times \boldsymbol{v}\|^2 = \|\boldsymbol{u}\|^2\|\boldsymbol{v}\|^2 - (\boldsymbol{u} \cdot \boldsymbol{v})^2 ∥ u × v ∥ 2 = ∥ u ∥ 2 ∥ v ∥ 2 − ( u ⋅ v ) 2 拉格朗日恒等式 [ u ] T = − [ u ] [\boldsymbol{u}]^{\mathrm{T}} = -[\boldsymbol{u}] [ u ] T = − [ u ] 反对称矩阵的反对称性 [ u ] v = − [ v ] u [\boldsymbol{u}]\boldsymbol{v} = -[\boldsymbol{v}]\boldsymbol{u} [ u ] v = − [ v ] u 交换反号
拉格朗日恒等式 :由 ∥ u × v ∥ = ∥ u ∥ ∥ v ∥ sin θ \|\boldsymbol{u} \times \boldsymbol{v}\| = \|\boldsymbol{u}\|\|\boldsymbol{v}\|\sin\theta ∥ u × v ∥ = ∥ u ∥∥ v ∥ sin θ
平方,代入 sin 2 θ = 1 − cos 2 θ \sin^2\theta = 1 - \cos^2\theta sin 2 θ = 1 − cos 2 θ
,结合 u ⋅ v = ∥ u ∥ ∥ v ∥ cos θ \boldsymbol{u} \cdot \boldsymbol{v} = \|\boldsymbol{u}\|\|\boldsymbol{v}\|\cos\theta u ⋅ v = ∥ u ∥∥ v ∥ cos θ 即得。
三重叉积(左展开) :取分量验证。x x x
分量:
[ u × ( v × w ) ] x = u y ( v x w y − v y w x ) − u z ( v z w x − v x w z ) [\boldsymbol{u} \times (\boldsymbol{v} \times \boldsymbol{w})]_x = u_y(v_x w_y - v_y w_x) - u_z(v_z w_x - v_x w_z) [ u × ( v × w ) ] x = u y ( v x w y − v y w x ) − u z ( v z w x − v x w z )
,整理为
v x ( u x w x + u y w y + u z w z ) − w x ( u x v x + u y v y + u z v z ) = v x ( u ⋅ w ) − w x ( u ⋅ v ) v_x(u_x w_x+u_y w_y+u_z w_z) - w_x(u_x v_x+u_y v_y+u_z v_z) = v_x(\boldsymbol{u} \cdot \boldsymbol{w}) - w_x(\boldsymbol{u} \cdot \boldsymbol{v}) v x ( u x w x + u y w y + u z w z ) − w x ( u x v x + u y v y + u z v z ) = v x ( u ⋅ w ) − w x ( u ⋅ v )
。其余分量同理。右展开可通过将左展开中 u \boldsymbol{u} u 与 w \boldsymbol{w} w 交换并取反号得到。
混合积:u ⋅ ( v × w ) = v ⋅ ( w × u ) = w ⋅ ( u × v ) = det ( u , v , w ) \boldsymbol{u} \cdot (\boldsymbol{v} \times \boldsymbol{w}) = \boldsymbol{v} \cdot (\boldsymbol{w} \times \boldsymbol{u}) = \boldsymbol{w} \cdot (\boldsymbol{u} \times \boldsymbol{v}) = \det(\boldsymbol{u}, \boldsymbol{v}, \boldsymbol{w}) u ⋅ ( v × w ) = v ⋅ ( w × u ) = w ⋅ ( u × v ) = det ( u , v , w )
2. 矩阵
2.1 矩阵类型
由 m × n m \times n m × n 个数排成的 m m m 行 n n n 列数表称为矩阵。矩阵 A A A 可看作由 m m m 个 n n n 维行向量组成,或由 n n n 个 m m m 维列向量组成。
类型 定义 记法 方阵 m = n m = n m = n A n × n A_{n \times n} A n × n 对角矩阵 仅主对角线存在非零元素 A = diag ( a 11 , a 22 , … , a n n ) A = \operatorname{diag}(a_{11}, a_{22}, \ldots, a_{nn}) A = diag ( a 11 , a 22 , … , a nn ) 零矩阵 / 单位矩阵 全为零 / 对角全为 1 O O O / I I I 对称矩阵 A = A T A = A^{\mathrm{T}} A = A T - 反对称矩阵 A = − A T A = -A^{\mathrm{T}} A = − A T - 奇异矩阵 det ( A ) = 0 \det(A) = 0 det ( A ) = 0 - 正交矩阵 A A T = A T A = I AA^{\mathrm{T}} = A^{\mathrm{T}}A = I A A T = A T A = I 列向量均为单位正交向量 正定矩阵 实对称且特征值全为正 -
2.2 矩阵运算
运算 性质 加法 交换律、结合律:A + B = B + A A+B = B+A A + B = B + A ,( A + B ) + C = A + ( B + C ) (A+B)+C = A+(B+C) ( A + B ) + C = A + ( B + C ) 数乘 λ ( μ A ) = ( λ μ ) A \lambda(\mu A) = (\lambda\mu)A λ ( μ A ) = ( λ μ ) A ;( λ + μ ) A = λ A + μ A (\lambda+\mu)A = \lambda A + \mu A ( λ + μ ) A = λ A + μ A 乘法 结合律、分配律,不满足交换律 :A B ≠ B A AB \neq BA A B = B A 转置 ( A B ) T = B T A T (AB)^{\mathrm{T}} = B^{\mathrm{T}}A^{\mathrm{T}} ( A B ) T = B T A T 行列式 ∥ A T ∥ = ∥ A ∥ \|A^{\mathrm{T}}\| = \|A\| ∥ A T ∥ = ∥ A ∥ ;∥ λ A ∥ = λ n ∥ A ∥ \|\lambda A\| = \lambda^n \|A\| ∥ λ A ∥ = λ n ∥ A ∥ ;∥ A B ∥ = ∥ A ∥ ∥ B ∥ \|AB\| = \|A\|\|B\| ∥ A B ∥ = ∥ A ∥∥ B ∥ 逆 ( A B ) − 1 = B − 1 A − 1 (AB)^{-1} = B^{-1}A^{-1} ( A B ) − 1 = B − 1 A − 1 ;( A − 1 ) T = ( A T ) − 1 (A^{-1})^{\mathrm{T}} = (A^{\mathrm{T}})^{-1} ( A − 1 ) T = ( A T ) − 1 ;∥ A − 1 ∥ = 1 / ∥ A ∥ \|A^{-1}\| = 1/ \|A\| ∥ A − 1 ∥ = 1/∥ A ∥
特征值与特征向量:A u = λ u A\boldsymbol{u} = \lambda \boldsymbol{u} A u = λ u ,则 λ \lambda λ 为 A A A 的特征值,u \boldsymbol{u} u
为对应特征向量。n n n 阶方阵 A A A 的特征值满足 ∑ λ i = tr ( A ) \sum \lambda_i = \operatorname{tr}(A) ∑ λ i = tr ( A ) ,∏ λ i = det ( A ) \prod \lambda_i = \det(A) ∏ λ i = det ( A ) 。
相似矩阵与相似变换:若存在可逆矩阵 P P P 使得 B = P A P − 1 B = PAP^{-1} B = P A P − 1 ,则 A A A 与 B B B 的特征值相同。对实对称矩阵,必存在正交矩阵 P P P
使得 A = P Λ P T A = P\Lambda P^{\mathrm{T}} A = P Λ P T (对角化)。
矩阵指数:e A = ∑ n = 0 ∞ A n n ! e^A = \sum_{n=0}^{\infty} \frac{A^n}{n!} e A = ∑ n = 0 ∞ n ! A n 。仅当 A B = B A AB = BA A B = B A 时才有 e A e B = e A + B e^A e^B = e^{A+B} e A e B = e A + B 。
2.3 线性空间
线性空间 :设 V V V 为非空集合,R R R
为实数域。若加法和数乘运算封闭且满足八条线性运算法则(交换律、结合律、零元素、负元素、单位元素、数乘结合律、数乘分配律×2),则 V V V
为线性空间。
若 V V V 中存在 n n n 个线性无关的元素 a 1 , … , a n \boldsymbol{a}_1, \ldots, \boldsymbol{a}_n a 1 , … , a n 可线性表示 V V V 中任一元素,则它们构成 V V V
的一组基 ,n n n 为 V V V 的维数,( x 1 , … , x n ) T (x_1, \ldots, x_n)^{\mathrm{T}} ( x 1 , … , x n ) T 为对应坐标。
线性变换 :设 T T T 为从线性空间 V V V 到 U U U
的映射,满足 T ( a 1 + a 2 ) = T ( a 1 ) + T ( a 2 ) T(\boldsymbol{a}_1+\boldsymbol{a}_2) = T(\boldsymbol{a}_1)+T(\boldsymbol{a}_2) T ( a 1 + a 2 ) = T ( a 1 ) + T ( a 2 )
且 T ( λ a ) = λ T ( a ) T(\lambda \boldsymbol{a}) = \lambda T(\boldsymbol{a}) T ( λ a ) = λ T ( a ) ,则 T T T 为线性变换。若 P P P
为正交矩阵,线性变换 y = P x \boldsymbol{y} = P\boldsymbol{x} y = P x 称正交变换 ——保持向量长度不变。
2.4 雅可比
设 x i = f i ( q 1 , q 2 , … , q n ) x_i = f_i(q_1, q_2, \ldots, q_n) x i = f i ( q 1 , q 2 , … , q n ) (i = 1 , … , n i=1, \ldots, n i = 1 , … , n
),写成列向量 X = [ f 1 ( q ) , … , f n ( q ) ] T \boldsymbol{X} = [f_1(\boldsymbol{q}), \ldots, f_n(\boldsymbol{q})]^{\mathrm{T}} X = [ f 1 ( q ) , … , f n ( q ) ] T 。对 q \boldsymbol{q} q
求微分(全微分):
δ X = J ( q ) δ q \delta\boldsymbol{X} = \boldsymbol{J}(\boldsymbol{q})\,\delta\boldsymbol{q} δ X = J ( q ) δ q
其中 J \boldsymbol{J} J 为雅可比矩阵 (Jacobian):
J = ∂ X ∂ q = [ ∂ f 1 ∂ q 1 ⋯ ∂ f 1 ∂ q n ⋮ ⋱ ⋮ ∂ f n ∂ q 1 ⋯ ∂ f n ∂ q n ] \boldsymbol{J} = \frac{\partial \boldsymbol{X}}{\partial \boldsymbol{q}} =\begin{bmatrix}\frac{\partial f_1}{\partial q_1} & \cdots & \frac{\partial f_1}{\partial q_n} \\\vdots & \ddots & \vdots \\\frac{\partial f_n}{\partial q_1} & \cdots & \frac{\partial f_n}{\partial q_n}\end{bmatrix} J = ∂ q ∂ X = ∂ q 1 ∂ f 1 ⋮ ∂ q 1 ∂ f n ⋯ ⋱ ⋯ ∂ q n ∂ f 1 ⋮ ∂ q n ∂ f n
两端同时乘以 δ q / δ t \delta\boldsymbol{q}/\delta t δ q / δ t ,得到速度映射:
X ˙ = J ( q ) q ˙ \dot{\boldsymbol{X}} = \boldsymbol{J}(\boldsymbol{q})\,\dot{\boldsymbol{q}} X ˙ = J ( q ) q ˙
在机器人学中,若 X \boldsymbol{X} X 为位置矢量,该式反映关节速度到末端速度的映射。