如何给定两个gps坐标 算出航向角_如何获得飞机的小扰动模型

8b005286bba2fc819922573fb62525e0.png
一、飞机运动方程分析
二、线性化的基本步骤
三、纵向运动线性小扰动模型
四、横航向运动线性小扰动模型
五、参考文献

一、飞机运动方程分析

要描述一个飞机的飞行状态,我们通常需要9个状态变量,即:

即飞机的飞行速度

,滚转角速率、俯仰角速率以及航向角速率
,滚转角、俯仰角以及偏航角

其中航向角

不影响受力分析,这个也很容易理解,假设你在一块很大的平地上骑自行车,而且没有风,那往哪个方向骑,都应该是一样费力的,如下图所示。

7ff01d67b39dea3b86ece6c10a12a815.gif

因此,对于飞机的飞行力学方程而言,我们只需要搞定剩余8个状态变量即可。

说完状态变量,我们再来分析一下控制变量。在文章J Pan:飞机是怎么飞起来的 我们介绍了,飞机的控制主要通过三个主舵面来完成:升降舵控制飞机俯仰运动;副翼控制飞机的滚转运动;方向舵控制飞机的航向运动。也就是说通过舵面的偏转量可以控制飞机的姿态,这三个控制变量用

来表示,其中
为副翼(
aileron)偏转量,
为升降舵(
elevator)偏转量,
为方向舵(
rudder)偏转量。

2566ef4b48ee7c6fe634f6301b90f51b.gif

除此之外,我们还需要一个重要的控制变量,那就是发动机的油门(Throttle),我们用

表示。

a1b66f35aa297070bcbc3b4b6da45023.gif

总结一下就是飞机可以通过如下变量定义其飞行运动:

状态变量为:

控制变量为:

那飞机运动方程具体是什么样呢?在文章J Pan:如何获得飞机运动方程 我们给出了飞机三个方向的力平衡方程如下:

以及力矩方程

看着就头疼,是吗?——实际上还会更头疼,因为控制变量

以及姿态角
体现在方程右侧的力
以及力矩
里面,如果展开的话,形式会更复杂。这个方程组不仅仅看着复杂,而且是严重非线性的,是无法得到解析解的,这也给我们预估飞机的飞行特性带来很大的困难。

那怎么办呢?——无它,简化而已。后面我们将主要进行方程简化的思路和逻辑,为使精力都集中在关键点,我们先将先将前面飞机运动方程改写成形式:

简化的方式是利用泰勒展开,核心思想是抓大放小,如下图所示

633019840c1e50a3d386cf27452ebeed.png
图片来源:https://www.zhihu.com/question/25627482/answer/313088784

就像素描一样,最关键的一步是轮廓的搭建(树干),也就是确定各个部位的大致的空间分布,在此基础上再逐步刻画细节(枝叶)。比如,按照泰勒公式,我们可以把指数函数展开成幂级数的形式:

而研究幂级数要比要就超越函数

要简单多了。关于泰勒公式的理解,推荐文章怎样更好地理解并记忆泰勒展开式?(作者原知乎用户陈二喜)。显然,幂级数的形式越高,刻画越精细(见右侧苍老师),但是也越复杂;幂级数越低,刻画约粗糙(见上图左侧),同时也越简单。我们需要在简约和精确之间找到一个平衡,幸运的是,对于平飞的飞机而言,我们只保
留线性项,就可以获得比较满意的结果,我们把这种方法称之为小扰动模型或者增量式模型。

二、线性化的基本步骤

对于非线性方程

我们通常很难获得其解析解。那怎么研究其特性呢?不妨先用一个稍微简单一点的函数研究一下,假如我们有如下非线性方程组:

  • 0
    点赞
  • 4
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
在osg中,我们可以使用osg::Matrixd类来表示一个矩阵,并且使用该矩阵来设置模型的朝向。下面是一个示例代码,该代码接受两个经纬度坐标和一个修正,然后计算出模型的朝向矩阵: ``` #include <osg/Matrix> #include <osg/Vec3d> #include <osg/CoordinateSystemNode> // 计算两个经纬度坐标的方向向量 osg::Vec3d computeDirection(osg::Vec3d from, osg::Vec3d to) { // 将经纬度坐标转换为笛卡尔坐标 osg::ref_ptr<osg::EllipsoidModel> ellipsoid = new osg::EllipsoidModel(); osg::Vec3d from_xyz, to_xyz; ellipsoid->convertLatLongHeightToXYZ(from.x(), from.y(), 0, from_xyz.x(), from_xyz.y(), from_xyz.z()); ellipsoid->convertLatLongHeightToXYZ(to.x(), to.y(), 0, to_xyz.x(), to_xyz.y(), to_xyz.z()); // 计算方向向量 return to_xyz - from_xyz; } // 根据方向向量和修正计算矩阵 osg::Matrixd computeRotationMatrix(osg::Vec3d direction, double angle) { // 计算旋转轴 osg::Vec3d axis = direction ^ osg::Vec3d(0, 0, 1); // 计算旋转矩阵 osg::Matrixd rotation; rotation.makeRotate(osg::DegreesToRadians(angle), axis); return rotation; } // 根据两个经纬度坐标和修正设置模型的朝向 void setModelOrientation(osg::Node* model, osg::Vec3d from, osg::Vec3d to, double angle) { // 计算方向向量和旋转矩阵 osg::Vec3d direction = computeDirection(from, to); osg::Matrixd rotation = computeRotationMatrix(direction, angle); // 设置模型的朝向矩阵 osg::MatrixTransform* transform = dynamic_cast<osg::MatrixTransform*>(model); if (transform) { transform->setMatrix(rotation); } } ``` 请注意,该代码假设模型已经被包装在一个osg::MatrixTransform节点中。如果模型没有被包装,则需要将其包装在osg::MatrixTransform节点中,并将该节点添加到场景图中。此外,该代码还假设使用WGS84椭球体模型来计算经纬度坐标的笛卡尔坐标。如果使用其他椭球体模型,则需要相应地修改代码。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值