随笔:为何无人机的机体系向惯性系的旋转矩阵就是无人机的姿态在惯性系中的表示

设世界坐标系为 WWW,机体坐标系为 BBB。

设有一自由向量p\mathbf{p}p,其在机体系下的坐标为:

pB=(p1,p2,p3)T\mathbf{p}^B = (p_1, p_2, p_3)^TpB=(p1,p2,p3)T

记机体系的三个基向量分别为 xB\mathbf{x}_BxB、yB\mathbf{y}_ByB、zB\mathbf{z}_BzB,则该向量用无人机机体系的基向量表示为:

p=p1⋅xB+p2⋅yB+p3⋅zB\mathbf{p} =p_1\cdot \mathbf{x}_B + p_2\cdot \mathbf{y}_B + p_3\cdot \mathbf{z}_Bp=p1⋅xB+p2⋅yB+p3⋅zB

之后把上面这个几何等式的每一项,都用世界系的坐标来表达:

pW=p1⋅xBW+p2⋅yBW+p3⋅zBW\mathbf{p}^W = p_1\cdot \mathbf{x}_B^W + p_2\cdot \mathbf{y}_B^W + p_3\cdot \mathbf{z}_B^WpW=p1⋅xBW+p2⋅yBW+p3⋅zBW

其中 xBW\mathbf{x}_B^WxBW、yBW\mathbf{y}_B^WyBW、zBW\mathbf{z}_B^WzBW分别为机体系的基向量xB\mathbf{x}_BxB、yB\mathbf{y}_ByB、zB\mathbf{z}_BzB在世界系下的坐标表达。pW\mathbf{p}^WpW为向量p\mathbf{p}p在世界系下的坐标表示。

再写成矩阵形式pW=xBWyBWzBWp1p2p3 \mathbf{p}^W = \begin{bmatrix} \mathbf{x}_B^W & \mathbf{y}_B^W & \mathbf{z}_B^W \end{bmatrix} \begin{bmatrix} p_1\\ p_2\\ p_3 \end{bmatrix} pW=xBWyBWzBW p1p2p3

记矩阵RBW=xBWyBWzBWR_B^W = \begin{bmatrix} \mathbf{x}_B^W & \mathbf{y}_B^W & \mathbf{z}_B^W \end{bmatrix}RBW=xBWyBWzBW

则结合上式可得

pW=RBW⋅pB\mathbf{p}^W = R_B^W \cdot \mathbf{p}^BpW=RBW⋅pB

观察该式的左右两侧可得,该式将向量p\mathbf{p}p在机体系中的坐标表示转换为在世界系中的坐标表示: RBWR_B^WRBW 是从机体系到世界系的旋转矩阵

RBWR_B^WRBW 的三列,就是机体系的三个基向量在世界系下的坐标,也就是机体系三个坐标轴相对于世界系的方向。

相关推荐
向哆哆12 小时前
无人机灾害场景人体目标检测数据集分享(适用于YOLO系列深度学习分类检测任务)
yolo·目标检测·无人机
haishikeji696_13 小时前
市域低空巡查平台架构|无人机管理系统、飞控管理平台、无人机巡检平台、无人机智慧巡查系统
架构·无人机·低空经济·无人机管理系统·飞控管理平台
Ricardo-Yang1 天前
无人机单目深度估计测试:ZipDepth 与 AerialMetric
人工智能·算法·机器学习·计算机视觉·无人机
沈阳昊天环宇无人机小编辑3 天前
无人机测绘点云实操体验与丹东作业筹备展望,沈阳无人机外出测绘作业
无人机
workflower3 天前
智能无人机成低空经济核心赛道
运维·人工智能·机器学习·机器人·云计算·无人机
tianxuanjg4 天前
0.005mm 高精度 CNC 加工:机器人薄壁复杂零件变形控制与全维度品控方案
经验分享·机器人·无人机·制造·材质
沈阳昊天环宇无人机小编辑4 天前
无人机执照对直招军士招录与发展的赋能作用,文案由沈阳昊天环宇编辑整理 | 聚焦新质战斗力,助力青年直招军士梦
无人机
airobotcn4 天前
空地一体化巡检机器人系统落地实战指南
安全·机器人·无人机·智慧园区·巡逻
tianxuanjg4 天前
机器人精密零件:为何样品合格,批量却频频超差?
人工智能·经验分享·机器人·无人机·制造·材质
airobotcn4 天前
AI Agent下工厂:大模型如何驱动巡检机器人自主决策
人工智能·机器人·自动化·无人机