
355
Рис. 8. 27. Внешний вид блока S_DUE
В завершение изменим название под блоком на такое "Дин. Уравн. Эйлера", чтобы точнее отобразить сущность
преобразований, которые осуществляет блок.
В дальнейшем, для моделирования процесса управления ориентацией, например, космического аппарата (КА),
обращающегося вокруг планеты по определенной замкнутой орбите, станет необходимым еще один блок,
осуществляющий интегрирование кинематических уравнений
ориентации, вычисляя значения параметров,
определяющих текущее угловое положение корпуса КА относительно орбитальной системы отсчета. Если в
качестве такого параметра принять кватернион поворота
, который переводит текущее положение КА в
нужное, соответствующие кинематические уравнения будут иметь вид
Q
)(
2
1
QΩωQ
Q
oo
−=
dt
d
,
где обозначено:
- вектор-кватернион абсолютной угловой скорости КА;
Ω
- вектор-кватернион абсолютной
угловой скорости орбитальной системы отсчета (жестко связанной с положением КА на орбите);
o
- знак
кватернионного умножения.
ω
Кватернионное кинематическое уравнение недостаточно удобно для проведения вычислений из-за того, что
действия над кватернионами существенно отличаются от действий над матрицами и не предусмотрены в
системе MatLab. Значительно удобнее превратить его в совокупность сугубо матричных уравнений:
⎪
⎩
⎪
⎨
⎧
+⋅×+−⋅=
−⋅−=
)]()()([
2
1
)(
2
1
0
0
ΩωqΩω
q
Ωωq
q
dt
d
dt
dq
t
(8.5)
В этих уравнениях величины
,
ω
и суть векторы-столбцы из проекций, соответственно, векторной части
кватерниона поворота, вектора абсолютной угловой скорости КА на оси связанной системы координат и
вектора угловой скорости орбитальной системы координат на ее же оси;
скалярная часть кватерниона
поворота; (
Ω
0
q
×
) – обозначения кососиметричной матрицы, составленной из проекций вектора
.
Создадим М-файл S-функции, осуществляющей интегрирование этих кинематических уравнений. Ниже
приведен текст этого М-файла по имени
S_KUqwat.
function [sys,x0,str,ts] = S_KUqwat(t,x,u,flag,OM0,Qw0)
% S-функция S_KUqwat Кинематических Уравнений в кватернионах
% Реализует переход от заданного вектора абсолютной
% угловой скорости орбитального космического аппарата
% к кватерниону поворота КА относительно орбитальной
% системы отсчета
% ВХОД блока:
% u = [omx,omy,omz]- вектор проекций абсолютной угловой
% скорости КА на оси CК, жестко связанной с ним
% ВЫХОД блока:
% y=[qw0,qw1,qw2,qw3] - вектор компонентов кватерниона поворота
% относительно орбитальной декартової системы координат
% Входные ПАРАМЕТРЫ S-функции:
% OM0 - орбитальная угловая скорость;
% Qw0 - вектор начального кватерниона поворота
% Лазарев Ю.ф. Укрaїна 18-12-2001