主要内容

6自由度(欧拉角)

实施六度自由度运动方程的欧拉角表示

  • 图书馆:
  • 航空航天块组/运动方程式/ 6dof

  • 6dof(欧拉角)块

描述

6自由度(欧拉角)块实现了六自由度运动方程的欧拉角表示,同时考虑了固定坐标系的旋转(XB.,Y.B.,z.B.)关于平坦的地球参考框架(XE.,Y.E.,z.E.).有关这些参考点的更多信息,请参见算法

限制

块假设所施加的力在主体的重心处起作用,并且质量和惯性是恒定的。

港口

输入

全部展开

应用的力,指定为一个三元素向量。

数据类型:

应用矩,指定为一个三元素向量。

数据类型:

输出

全部展开

平坦地球参考框架中的速度,作为三元素向量返回。

数据类型:

在平坦的地球参考框架中的位置,作为三元素向量返回。

数据类型:

欧拉旋转角度[滚转,俯仰,偏航],返回为三个元素矢量,以弧度表示。

数据类型:

从平面地球轴到固定体轴的坐标转换,返回为一个3 × 3矩阵。

数据类型:

身体固定框架中的速度作为三元素向量返回。

数据类型:

固定轴上的角速率,返回为一个三元素矢量,单位为每秒弧度。

数据类型:

身体固定轴的角度加速度,作为三元素向量返回,在每秒平方的弧度中。

数据类型:

相对于身体坐标系的固定轴上的加速度,返回为一个三元素向量。

数据类型:

身体固定轴相对于惯性框架(平地球)的加速度,作为三元素向量返回。您通常将此信号连接到加速度计。

依赖关系

该端口仅在包括惯性加速度复选框被选中。

数据类型:

参数

全部展开

主要

输入输出单元,指定为度量(MKS)英语(速度(ft/s)),或英语(速度单位:kts)

单位 部队 时刻 加速 速度 位置 质量 惯性
度量(MKS) 牛顿 牛顿米 每秒平方米 米/秒 公斤 公斤平方米
英语(速度(ft/s)) 英镑 尺磅 英尺每秒平方 英尺/秒 鼻涕虫 Slug脚平方
英语(速度单位:kts) 英镑 尺磅 英尺每秒平方 鼻涕虫 Slug脚平方

程序使用

块参数:单位
类型:特征向量
价值观:度量(MKS)|英语(速度(ft/s))|英语(速度单位:kts)
默认:度量(MKS)

质量类型,根据下表指定。

简单的变量选择符合先前描述的运动方程。

程序使用

块参数:mtype
类型:特征向量
价值观:固定|简单的变量|自定义变量
默认:简单的变量

运动表示方程,具体如下表所示。

表示 描述

欧拉角

在运动方程中使用欧拉角。

四元数

在运动方程中使用四元数。

四元数选择符合运动方程算法

程序使用

块参数:rep
类型:特征向量
价值观:欧拉角|四元数
默认:'欧拉角'

物体在地球平面参照系中的初始位置,指定为一个三元矢量。

程序使用

块参数:XME_0.
类型:特征向量
价值观:' (0 0 0) '|三元素向量
默认:' (0 0 0) '

在身体固定坐标系中,身体轴上的初始速度,指定为一个三元素矢量。

程序使用

块参数:VM_0.
类型:特征向量
价值观:' (0 0 0) '|三元素向量
默认:' (0 0 0) '

初始欧拉方向角[滚转,俯仰,偏航],指定为三个元素矢量,以弧度表示。欧拉旋转角度是指物体与东北下(NED)坐标系之间的角度。

程序使用

块参数:eul_0
类型:特征向量
价值观:' (0 0 0) '|三元素向量
默认:' (0 0 0) '

相对于NED帧的初始身体固定角速率,指定为一个三元素矢量,单位为每秒弧度。

程序使用

块参数:pm_0
类型:特征向量
价值观:' (0 0 0) '|三元素向量
默认:' (0 0 0) '

刚体的初始质量,指定为双标量。

程序使用

块参数:mass_0
类型:特征向量
价值观:“1.0”|双标量
默认:“1.0”

身体的惯性,指定为双标量。

依赖关系

启用此参数,设置质量类型固定

程序使用

块参数:惯性
类型:特征向量
价值观:(3)|双标量
默认:(3)

选中此复选框以添加惯性加速端口。

依赖关系

启用一种端口,选择此参数。

程序使用

块参数:abi_flag
类型:特征向量
价值观:“关闭”|'在'
默认:离开

状态属性

为每个状态分配唯一的名称。在线性化过程中,可以使用状态名而不是块路径。

  • 若要将名称分配给单个状态,请在引号之间输入唯一名称,例如:'速度'

  • 要将名称分配给多个状态,请输入由括号包围的逗号分隔列表,例如,{' a ', ' b ', ' c '}.每个名称必须是唯一的。

  • 如果参数为空(' '),不会发生名称分配。

  • 状态名称仅应用于带有name参数的选定块。

  • 州的数目必须在州名的数目中平均分配。

  • 可以指定比状态更少的名称,但不能指定比状态更多的名称。

    例如,您可以在具有四种状态的系统中指定两个名称。第一个名字适用于前两个州,第二个名字适用于后两个州。

  • 在MATLAB中使用变量分配状态名®工作区,输入不带引号的变量。变量可以是字符向量、单元格数组或结构。

位置状态名称,指定为由括号包围的逗号分隔列表。

程序使用

块参数:xme_statename.
类型:特征向量
价值观:''用大括号括起来的|逗号分隔的列表
默认:''

Velocity状态名称,指定为由括号包围的逗号分隔列表。

程序使用

块参数:vm_statename.
类型:特征向量
价值观:''用大括号括起来的|逗号分隔的列表
默认:''

Euler旋转角度状态名称,指定为由括号包围的逗号分隔列表。

程序使用

块参数:eul_statename
类型:特征向量
价值观:''用大括号括起来的|逗号分隔的列表
默认:''

身体旋转速率状态名,指定用大括号括起来的逗号分隔列表。

程序使用

块参数:pm_statename.
类型:特征向量
价值观:''用大括号括起来的|逗号分隔的列表
默认:''

算法

6自由度(欧拉角)块使用这些参考帧概念。

  • 身体固定坐标框架的起源是主体的重心,并且假设身体是刚性的,假设消除了考虑在各个质量元件之间作用的力的需要。

    平坦的地球参考系被认为是惯性的,这是一个极好的近似,使得地球相对于“恒星”的运动所产生的力可以被忽略。

  • 身体固定坐标框架的平移运动,其中施加的力[FXFyFZ.]T.在身体固定的框架中,身体的质量是多少m被认为是常数。

    F ¯ B. = [ F X F y F Z. ] = m V. ¯ ˙ B. + ω ¯ × V. ¯ B. 一种 B. B. = [ ˙ B. V. ˙ B. W. ˙ B. ] = 1 m F ¯ B. ω ¯ × V. ¯ B. 一种 B. E. = 1 m F B. V. ¯ B. = [ B. V. B. W. B. ] ω ¯ = [ P. 问: R. ]

  • 固定体框架的转动动力学,其中施加的力矩为[L M N]T.和惯性张量一世是关于原点O的。

    m ¯ B. = [ L. m N ] = 一世 ω ¯ ˙ + ω ¯ × 一世 ω ¯ 一世 = [ 一世 X X 一世 X y 一世 X Z. 一世 y X 一世 y y 一世 y Z. 一世 Z. X 一世 Z. y 一世 Z. Z. ]

  • 定体角速度矢量,[p q r]T.,以及欧拉角的变化率, [ ϕ ˙ θ ˙ ψ ˙ ] T. ,通过将欧拉速率解析到正文固定坐标框架来确定。

    [ P. 问: R. ] = [ ϕ ˙ 0. 0. ] + [ 1 0. 0. 0. COS. ϕ ϕ 0. ϕ COS. ϕ ] [ 0. θ ˙ 0. ] + [ 1 0. 0. 0. COS. ϕ ϕ 0. ϕ COS. ϕ ] [ COS. θ 0. θ 0. 1 0. θ 0. COS. θ ] [ 0. 0. ψ ˙ ] j 1 [ ϕ ˙ θ ˙ ψ ˙ ]

    反相j然后给出了确定欧拉速率向量所需的关系。

    [ ϕ ˙ θ ˙ ψ ˙ ] = j [ P. 问: R. ] = [ 1 ϕ 棕褐色 θ COS. ϕ 棕褐色 θ 0. COS. ϕ ϕ 0. ϕ COS. θ COS. ϕ COS. θ ] [ P. 问: R. ]

参考文献

[1]史蒂文斯,布莱恩和弗兰克刘易斯,飞机控制和模拟.霍博肯,新泽西州:第二版,约翰·威利父子,2003。

彼得·H·西普菲航空航天车辆动力学的建模与仿真.Reston,VA:第二版,AIAA教育系列,2007年。

扩展功能

C / c++代码生成
使用Simulink®Coder™生成C和c++代码。金宝app

在R2006A介绍