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

设世界坐标系为 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 的三列,就是机体系的三个基向量在世界系下的坐标,也就是机体系三个坐标轴相对于世界系的方向。

相关推荐
workflower1 小时前
智能体-企业行政问答助手
人工智能·机器学习·机器人·云计算·无人机
tianxuanjg5 小时前
工业/协作机器人研发采购指南:如何适配新品迭代的CNC加工合作
人工智能·经验分享·机器人·无人机·材质
dikong16886 小时前
政企采购在石家庄如何选择一站式无人机系统整体解决方案
无人机·天链通
RS迷途小书童1 天前
Python 解析大疆无人机 SRT 字幕日志
开发语言·python·无人机
亥时科技1 天前
跨区域无人机作业,如何做到近乎零延迟?
开源·无人机·ai巡检
公爵爱学习2 天前
无人机视觉识别前序-Linux-YOLO安装
python·yolo·计算机视觉·conda·无人机
dikong16882 天前
院校批量采购无人机渠道筛选,注重实训配套更关键
无人机·天链通无人机供应链
公爵爱学习2 天前
无人机多点巡航
游戏引擎·无人机·cocos2d
公爵爱学习2 天前
关于无人机定点飞行的一些解释和Matlab程序绘制
游戏引擎·无人机·cocos2d
梵亿2 天前
基于 STM32F103C8T6 的无人机低功耗设计与实现
stm32·嵌入式硬件·无人机·低功耗