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

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

相关推荐
梦想的初衷~14 小时前
【完整教程】基于Python的无人机多光谱-点云融合生态三维建模:从Metashape重建到碳储量/生物量/LULC预测
python·无人机·三维重建·多光谱·无人机遥感·碳储量·生态建模
GrepowTattu16 小时前
无人机足球电池怎么选?容量、电压、倍率与安全性解析
无人机
机器学习之心16 小时前
基于遗传粒子群混合算法的无人机三维路径规划:Matlab 实现与多算法对比分析
算法·matlab·无人机·无人机三维路径规划·遗传粒子群混合算法
沈阳昊天环宇无人机小编辑2 天前
暑假备考无人机CAAC飞手证书:视距内和超视距到底要如何选择?
无人机
YOLO数据集集合2 天前
无人机松材线虫病树监测:早期与晚期感染阶段目标检测数据集全解析10125期
人工智能·目标检测·无人机
GAOJ_K4 天前
高速工况钢珠离心力如何影响螺杆磨损与运行平顺性?
人工智能·无人机·制造
daad7775 天前
记录无人机的compass
无人机
CS_Zero6 天前
无人机避障仿真系统:Gazebo+PX4+ROS2+Fast-LIO2+SUPER框架联调
无人机·ros2
灵翼飞航科技有限公司6 天前
2026款WF-EN系列多功能发动机测试台(适用DLE、林巴赫、Rotax等发动机)
功能测试·测试工具·无人机
24年生活经验_小旻22 天前
ROS2+Ardupilot+Gazebo通信仿真基本环境搭建
无人机