6DOF (Кватернион)

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

Библиотека

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

Описание

Для описания системы координат и переводной динамики, см. описание блока для блока 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`	Масса и изменения инерции настраиваемы.

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

Representation

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

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

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

Initial position in inertial axes

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

Initial velocity in body axes

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

Initial Euler rotation

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

Initial body rotation rates

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

Initial Mass

Масса твердого тела.

Inertia matrix

3х3 матрица тензора инерции I.

Gain for quaternion normalization

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

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'}

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

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

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

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

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

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

Входной параметр	Тип размерности	Описание
Сначала	Вектор	Содержит эти три приложенных силы.
Второй	Вектор	Содержит три прикладных момента.

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