1.1 - 机构学的通用数学基础

机器人机构学

点、直线、平面是几何学中最基本的元素。如何表征它们,进而描述其运动,是不同几何理论研究的基础。


本章为全书后续各章提供数学基础——从三维向量与矩阵出发,经线几何过渡到旋量与旋量系。

1. 向量

1.1 点的坐标表示

空间直角坐标系中,点 PP 的位置用坐标原点指向该点的向量 P\boldsymbol{P} 表示:

P=Pxi+Pyj+Pzk\boldsymbol{P} = P_x \boldsymbol{i} + P_y \boldsymbol{j} + P_z \boldsymbol{k}

其中 i\boldsymbol{i}、j\boldsymbol{j}、k\boldsymbol{k} 分别为平行于 xx、yy、zz 轴的单位向量;PxP_x、PyP_y、PzP_z 为向量在各轴方向的投影。

写成列向量形式:

P=[PxPyPz]\boldsymbol{P} = \begin{bmatrix} P_x \\ P_y \\ P_z \end{bmatrix}

1.2 加法与数乘

向量是既有大小又有方向的量。nn 维向量是 nn 个有序数组成的数组,写成一行称行向量 aT=(a1,a2,…,an)\boldsymbol{a}^{\mathrm{T}} = (a_1, a_2, \ldots, a_n),写成一列称列向量。

两三维向量 u=uxi+uyj+uzk\boldsymbol{u} = u_x \boldsymbol{i} + u_y \boldsymbol{j} + u_z \boldsymbol{k} 和 v=vxi+vyj+vzk\boldsymbol{v} = v_x \boldsymbol{i} + v_y \boldsymbol{j} + v_z \boldsymbol{k} 的加减法:

u±v=(ux±vx)i+(uy±vy)j+(uz±vz)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}

加减法满足封闭性,遵循平行四边形或三角形法则。

1.3 点积

向量的点积(内积):u⋅v=uxvx+uyvy+uzvz\boldsymbol{u} \cdot \boldsymbol{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∥=ux2+uy2+uz2\|\boldsymbol{u}\| = \sqrt{u_x^2+u_y^2+u_z^2} 为向量的范数(模)。

特例表达式意义
v\boldsymbol{v} 为单位向量(如 i\boldsymbol{i})u⋅i=∥u∥cos⁡θ\boldsymbol{u} \cdot \boldsymbol{i} = \|\boldsymbol{u}\| \cos\thetau\boldsymbol{u} 在 xx 轴上的投影
两者均为单位向量i⋅j=cos⁡90∘=0\boldsymbol{i} \cdot \boldsymbol{j} = \cos 90^\circ = 0方向余弦,正交时点积为零

1.4 叉积

两向量的叉积生成一个新向量,垂直于两向量张成的平面,方向符合右手定则:

u×v=∣ijkuxuyuzvxvyvz∣=(uyvz−uzvy)i+(uzvx−uxvz)j+(uxvy−uyvx)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∥=∥u∥∥v∥sin⁡θ\|\boldsymbol{u} \times \boldsymbol{v}\| = \|\boldsymbol{u}\| \|\boldsymbol{v}\| \sin\theta,等于两向量围成的平行四边形面积。

叉积可借助反对称矩阵 [u][\boldsymbol{u}] 表达为矩阵乘法:

[u]=[0−uzuyuz0−ux−uyux0],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}

运动学中的关键关系:角速度矢量与位置矢量叉积生成线速度矢量——v=ω×r\boldsymbol{v} = \boldsymbol{\omega} \times \boldsymbol{r}。

运算律总结:

运算交换律结合律分配律
点积u⋅v=v⋅u\boldsymbol{u} \cdot \boldsymbol{v} = \boldsymbol{v} \cdot \boldsymbol{u}—✓
叉积u×v=−v×u\boldsymbol{u} \times \boldsymbol{v} = -\boldsymbol{v} \times \boldsymbol{u}✗✓

常用叉积公式:

公式说明
u×u=0\boldsymbol{u} \times \boldsymbol{u} = \boldsymbol{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−(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∥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]T=−[u][\boldsymbol{u}]^{\mathrm{T}} = -[\boldsymbol{u}]反对称矩阵的反对称性
[u]v=−[v]u[\boldsymbol{u}]\boldsymbol{v} = -[\boldsymbol{v}]\boldsymbol{u}交换反号

拉格朗日恒等式:由 ∥u×v∥=∥u∥∥v∥sin⁡θ\|\boldsymbol{u} \times \boldsymbol{v}\| = \|\boldsymbol{u}\|\|\boldsymbol{v}\|\sin\theta 平方,代入 sin⁡2θ=1−cos⁡2θ\sin^2\theta = 1 - \cos^2\theta ,结合 u⋅v=∥u∥∥v∥cos⁡θ\boldsymbol{u} \cdot \boldsymbol{v} = \|\boldsymbol{u}\|\|\boldsymbol{v}\|\cos\theta 即得。

三重叉积(左展开):取分量验证。xx 分量: [u×(v×w)]x=uy(vxwy−vywx)−uz(vzwx−vxwz)[\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) ,整理为 vx(uxwx+uywy+uzwz)−wx(uxvx+uyvy+uzvz)=vx(u⋅w)−wx(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}) 。其余分量同理。右展开可通过将左展开中 u\boldsymbol{u} 与 w\boldsymbol{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})

2. 矩阵

2.1 矩阵类型

由 m×nm \times n 个数排成的 mm 行 nn 列数表称为矩阵。矩阵 AA 可看作由 mm 个 nn 维行向量组成,或由 nn 个 mm 维列向量组成。

类型定义记法
方阵m=nm = nAn×nA_{n \times n}
对角矩阵仅主对角线存在非零元素A=diag⁡(a11,a22,…,ann)A = \operatorname{diag}(a_{11}, a_{22}, \ldots, a_{nn})
零矩阵 / 单位矩阵全为零 / 对角全为 1OO / II
对称矩阵A=ATA = A^{\mathrm{T}}-
反对称矩阵A=−ATA = -A^{\mathrm{T}}-
奇异矩阵det⁡(A)=0\det(A) = 0-
正交矩阵AAT=ATA=IAA^{\mathrm{T}} = A^{\mathrm{T}}A = I列向量均为单位正交向量
正定矩阵实对称且特征值全为正-

2.2 矩阵运算

运算性质
加法交换律、结合律:A+B=B+AA+B = B+A,(A+B)+C=A+(B+C)(A+B)+C = A+(B+C)
数乘λ(μA)=(λμ)A\lambda(\mu A) = (\lambda\mu)A;(λ+μ)A=λA+μA(\lambda+\mu)A = \lambda A + \mu A
乘法结合律、分配律,不满足交换律:AB≠BAAB \neq BA
转置(AB)T=BTAT(AB)^{\mathrm{T}} = B^{\mathrm{T}}A^{\mathrm{T}}
行列式∥AT∥=∥A∥\|A^{\mathrm{T}}\| = \|A\|;∥λA∥=λn∥A∥\|\lambda A\| = \lambda^n \|A\|;∥AB∥=∥A∥∥B∥\|AB\| = \|A\|\|B\|
逆(AB)−1=B−1A−1(AB)^{-1} = B^{-1}A^{-1};(A−1)T=(AT)−1(A^{-1})^{\mathrm{T}} = (A^{\mathrm{T}})^{-1};∥A−1∥=1/∥A∥\|A^{-1}\| = 1/ \|A\|

特征值与特征向量:Au=λuA\boldsymbol{u} = \lambda \boldsymbol{u},则 λ\lambda 为 AA 的特征值,u\boldsymbol{u} 为对应特征向量。nn 阶方阵 AA 的特征值满足 ∑λi=tr⁡(A)\sum \lambda_i = \operatorname{tr}(A),∏λi=det⁡(A)\prod \lambda_i = \det(A)。

相似矩阵与相似变换:若存在可逆矩阵 PP 使得 B=PAP−1B = PAP^{-1},则 AA 与 BB 的特征值相同。对实对称矩阵,必存在正交矩阵 PP 使得 A=PΛPTA = P\Lambda P^{\mathrm{T}}(对角化)。

矩阵指数:eA=∑n=0∞Ann!e^A = \sum_{n=0}^{\infty} \frac{A^n}{n!}。仅当 AB=BAAB = BA 时才有 eAeB=eA+Be^A e^B = e^{A+B}。

2.3 线性空间

线性空间:设 VV 为非空集合,RR 为实数域。若加法和数乘运算封闭且满足八条线性运算法则(交换律、结合律、零元素、负元素、单位元素、数乘结合律、数乘分配律×2),则 VV 为线性空间。

若 VV 中存在 nn 个线性无关的元素 a1,…,an\boldsymbol{a}_1, \ldots, \boldsymbol{a}_n 可线性表示 VV 中任一元素,则它们构成 VV 的一组基,nn 为 VV 的维数,(x1,…,xn)T(x_1, \ldots, x_n)^{\mathrm{T}} 为对应坐标。

线性变换:设 TT 为从线性空间 VV 到 UU 的映射,满足 T(a1+a2)=T(a1)+T(a2)T(\boldsymbol{a}_1+\boldsymbol{a}_2) = T(\boldsymbol{a}_1)+T(\boldsymbol{a}_2) 且 T(λa)=λT(a)T(\lambda \boldsymbol{a}) = \lambda T(\boldsymbol{a}),则 TT 为线性变换。若 PP 为正交矩阵,线性变换 y=Px\boldsymbol{y} = P\boldsymbol{x} 称正交变换——保持向量长度不变。

2.4 雅可比

设 xi=fi(q1,q2,…,qn)x_i = f_i(q_1, q_2, \ldots, q_n)(i=1,…,ni=1, \ldots, n ),写成列向量 X=[f1(q),…,fn(q)]T\boldsymbol{X} = [f_1(\boldsymbol{q}), \ldots, f_n(\boldsymbol{q})]^{\mathrm{T}}。对 q\boldsymbol{q} 求微分(全微分):

δX=J(q) δq\delta\boldsymbol{X} = \boldsymbol{J}(\boldsymbol{q})\,\delta\boldsymbol{q}

其中 J\boldsymbol{J} 为雅可比矩阵(Jacobian):

J=∂X∂q=[∂f1∂q1⋯∂f1∂qn⋮⋱⋮∂fn∂q1⋯∂fn∂qn]\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}

两端同时乘以 δq/δt\delta\boldsymbol{q}/\delta t,得到速度映射:

X˙=J(q) q˙\dot{\boldsymbol{X}} = \boldsymbol{J}(\boldsymbol{q})\,\dot{\boldsymbol{q}}

在机器人学中,若 X\boldsymbol{X} 为位置矢量,该式反映关节速度到末端速度的映射。