Пользовательская переменная масса 6DOF (кватернион)

Реализуйте представление кватерниона шести уравнений степеней свободы движения пользовательской переменной массы относительно осей тела

Библиотека

Уравнения Motion/6DOF

Описание

Для описания системы координат и переводной динамики, см. описание блока для блока Custom Variable Mass 6DOF (Euler Angles).

Интегрирование скорости изменения вектора кватерниона приведено ниже. Усиление K управляет нормой вектора состояния кватерниона к 1,0, должно ε становиться ненулевым. Необходимо выбрать значение этого усиления с осторожностью, потому что большое значение улучшает уровень затухания ошибки в норме, но также и замедляет симуляцию, потому что введены быстрые движущие силы. Ошибка в значении в одном элементе вектора кватерниона распространена одинаково среди всех элементов, потенциально увеличив ошибку в векторе состояния.

$\begin{array}{l} [\begin{matrix} {\dot{q}}_{0} \\ {\dot{q}}_{1} \\ {\dot{q}}_{2} \\ {\dot{q}}_{3} \end{matrix}] = \frac{}{12} [\begin{matrix} 0 & - p & - q & - r \\ p & 0 & r & - q \\ q & - r & 0 & p \\ r & q & - p & 0 \end{matrix}] [\begin{matrix} q_{0} \\ q_{1} \\ q_{2} \\ q_{3} \end{matrix}] + K ε [\begin{matrix} q_{0} \\ q_{1} \\ q_{2} \\ q_{3} \end{matrix}] \\ ε = 1 - (q_{}^{02} + q_{}^{12} + q_{}^{22} + q_{}^{32}) . \end{array}$

Параметры

Основной

Units

Задает модули ввода и вывода:

Модули	Силы	Момент	Ускорение	Скорость	Положение	Масса	Инерция
`Metric (MKS)`	Ньютон	Ньютон-метр	Метры в секунду придали квадратную форму	Метры в секунду	Метры	Килограмм	Килограммометр придал квадратную форму
`English (Velocity in ft/s)`	Фунт	Фунт ноги	Ноги в секунду придали квадратную форму	Ноги в секунду	Футы	Краткий заголовок	Отложите нога придала квадратную форму
`English (Velocity in kts)`	Фунт	Фунт ноги	Ноги в секунду придали квадратную форму	Узлы	Футы	Краткий заголовок	Отложите нога придала квадратную форму

Mass Type

Выберите тип массы, чтобы использовать:

`Fixed`	Масса является постоянной в течение симуляции.
`Simple Variable`	Масса и инерция отличаются линейно как функция массового уровня.
`Custom Variable`	Масса и изменения инерции настраиваемы.

Выбор Custom Variable соответствует ранее описанным уравнениям движения.

Representation

Выберите представление использованию:

`Euler Angles`	Используйте Углы Эйлера в рамках уравнений движения.
`Quaternion`	Используйте кватернионы в рамках уравнений движения.

Выбор Quaternion соответствует ранее описанным уравнениям движения.

Initial position in inertial axes

Трехэлементный вектор для начального местоположения тела в плоском Наземном кадре ссылки.

Initial velocity in body axes

Трехэлементный вектор для начальной скорости в зафиксированном телом координатном кадре.

Initial Euler rotation

Трехэлементный вектор для начальных Эйлеровых углов поворота [список, подача, отклонение от курса], в радианах.

Initial body rotation rates

Трехэлементный вектор для начальной буквы зафиксированные телом угловые уровни, в радианах в секунду.

Gain for quaternion normalization

Усиление, чтобы поддержать норму вектора кватерниона равняется 1,0.

Include mass flow relative velocity

Установите этот флажок, чтобы добавить массовый скоростной порт родственника потока. Это - относительная скорость, в которой масса аккумулируется или удаляется.

Include inertial acceleration

Установите этот флажок, чтобы включить дополнительный выходной порт для ускорений в зафиксированных телом осях относительно инерционного кадра. Вы обычно соединяете этот сигнал с акселерометром.

Атрибуты состояния

Присвойте уникальное имя каждому состоянию. Можно использовать имена состояния вместо путей к блоку во время линеаризации.

Чтобы присвоить имя к одному состоянию, введите уникальное имя между кавычками, например, 'velocity'.
Чтобы присвоить имена к нескольким состояниям, введите разграниченный запятой список, окруженный фигурными скобками, например, {'a', 'b', 'c'}. Каждое имя должно быть уникальным.
Если параметр пуст (' '), никакое присвоение имени не происходит.
Имена состояния применяются только к выбранному блоку с параметром имени.
Количество состояний должно разделиться равномерно среди количества имен состояния.
Можно задать меньше имен, чем состояния, но вы не можете задать больше имен, чем состояния.
Например, можно задать два имени в системе с четырьмя состояниями. Имя применяется к первым двум состояниям и второму имени к последним двум состояниям.
Чтобы присвоить имена состояния с переменной в рабочей области MATLAB^®, введите переменную без кавычек. Переменная может быть вектором символов, массивом ячеек или структурой.

Position: e.g., {'Xe', 'Ye', 'Ze'}

Задайте имена состояния положения.

Значением по умолчанию является ''.

Velocity: e.g., {'U', 'v', 'w'}

Задайте скоростные имена состояния.

Значением по умолчанию является ''.

Quaternion vector: e.g., {'qr', 'qi', 'qj', 'qk'}

Задайте имена состояния вектора кватерниона. Этот параметр появляется, если параметр Representation устанавливается на Quaternion.

Значением по умолчанию является ''.

Body rotation rates: e.g., {'p', 'q', 'r'}

Задайте имена состояния уровня вращения тела.

Значением по умолчанию является ''.

Вводы и выводы

Входной параметр	Тип размерности	Описание
Сначала	Вектор	Содержит эти три приложенных силы.
Второй	Вектор	Содержит три прикладных момента.
Треть (Необязательно)	Вектор	Содержит одну или несколько скоростей изменения массы (положительный, если аккумулируется, отрицательный, если удалено).
Четвертый	Скаляр	Содержит массу.
Пятый	3х3 матрица	Содержит скорость изменения матрицы тензора инерции.
Шестой	3х3 матрица	Содержит матрицу тензора инерции.
Седьмой (Необязательно)	Трехэлементный вектор	Содержит одну или несколько относительных скоростей, в которых масса аккумулируется к или удаляется от тела в зафиксированных телом осях.

Вывод	Тип размерности	Описание
Сначала	Трехэлементный вектор	Содержит скорость в плоском Наземном кадре ссылки.
Второй	Трехэлементный вектор	Содержит положение в плоском Наземном кадре ссылки.
Треть	Трехэлементный вектор	Содержит Эйлеровы углы поворота [список, подача, отклонение от курса], в радианах.
Четвертый	3х3 матрица	Содержит координатное преобразование от плоских Наземных осей до зафиксированных телом осей.
Пятый	Трехэлементный вектор	Содержит скорость в зафиксированном телом кадре.
Шестой	Трехэлементный вектор	Содержит угловые уровни в зафиксированных телом осях, в радианах в секунду.
Седьмой	Трехэлементный вектор	Содержит угловые ускорения в зафиксированных телом осях, в радианах в секунду придал квадратную форму.
Восьмой	Трехэлементный вектор	Содержит ускорения в зафиксированных телом осях относительно каркаса кузова.
Девятый (Необязательно)	Трехэлементный вектор	Содержит ускорения в зафиксированных телом осях относительно инерционного кадра (плоская Земля). Вы обычно соединяете этот сигнал с акселерометром.