СИСТЕМА ОПРЕДЕЛЕНИЯ ГИДРОДИНАМИЧЕСКИХ КОЭФФИЦИЕНТОВ МАТЕМАТИЧЕСКОЙ МОДЕЛИ ДВИЖЕНИЯ СУДНА Российский патент 2014 года по МПК B63H25/04 G05B23/02 

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

Известны системы определения параметров математической модели движения судна, которые основаны на использования заданной структуры математической модели движения судна, вида:

где V_x, V_y, ω_z, φ - продольная, боковая и угловая скорости судна, угол курса, δ - угол перекладки руля,

a_ij - неизвестные параметры математической модели движения судна (подлежащие уточнению гидродинамические коэффициенты: a₁₁, a₁₂, a₁₃, a₂₁, a₂₂, a₂₃),

ς₁, ς₂, ς₃ - входные помехи с нулевыми средними и известными ковариационными матрицами M[ς_i(t)]=0 и

[П.В Попов Идентификация уравнений динамики подвижного аппарата по натурным данным ходовых испытаний ОАО «Концерн НПО «Аврора» С.Петербург // Сборник трудов ХХХУ111 Всероссийской конференции издательство ИПУ РАН 2012, г. Москва]

Известна система экспериментального определения влияния вариации коэффициента математической модели объекта на его динамику (SU 205913 А1, 01.02.1967). Выходной сигнал с исследуемого объекта запоминают (задерживают), формируют невязку, а затем пропускают через электронную модель исследуемого объекта, в котором варьируют величину коэффициента (постоянной времени) модели. Недостатком такой системы является идентификация только одного параметра идентифицируемой системы.

Известна система экспериментального определения параметров математической модели движения судна (RU 2151713 C1, 27.06.2000, принятый нами в качестве прототипа). Известная система использует только часть измеряемых фазовых координат состояния судна. Используя измеренные параметры и сформированные с использованием электронной модели движения судна, получают невязки, которые минимизируют путем вариации искомых величин гидродинамических коэффициентов в электронной модели.

Недостатки:

1) использование только части измеряемых фазовых координат состояния судна,

2) низкая точность идентификации гидродинамических коэффициентов математической модели движения судна,

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

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

- создание высокоточной математической модели движения судна, параметры которой уточняются в процессе рейса судна,

- повышение качества автоматического управления движением,

- повышение безопасности проводки судна в узкостях,

- снижение загрузки рулевого привода при сильном волнении.

Поставленные цели достигаются с помощью:

- введения подсистемы формирования коэффициентов усиления в процессе идентификации гидродинамических коэффициентов (введением блоков 10. и 11.);

- использования полного набора измерителей фазового состояния судна (включая измерители линейных dV_y/dt и угловых dω_z/dt ускорений);

- проведения идентификации при облегченных идентификационных режимах движения судна,

- определения значений гидродинамических коэффициентов путем решения двух независимых систем алгебраических уравнений.

Предлагаемая система идентификации позволяет в процессе рейса судна (практически не нарушая заданный режим движения) уточнять гидродинамические коэффициенты математической модели движения судна.

Математическая модель принята вида:

где V_x, V_y, ω_z - продольная, боковая и угловая скорости движения судна,

dV_y/dt - боковое (линейное) ускорение судна,

dω_z/dt - угловое ускорение судна,

δ - кормовой руль,

a_ij - неизвестные, подлежащие уточнению (шесть оценок) гидродинамические коэффициенты: a₁₁, a₁₂, a₁₃, a₂₁, a₂₂, a₂₃ путем решения систем алгебраических уравнений.

Технический результат достигается тем, что система идентификации гидродинамических коэффициентов математической модели движения судна содержит задатчик идентификационных маневров управления движением судна; блок измерения, включающий датчики бокового ускорения - dV_yi/dt, боковой скорости судна - V_yi, продольной скорости - V_xi, угловой скорости - ω_zi, угла перекладки руля - δ_i, углового ускорения - dω_zi/dt в момент времени i, в блоке формируются также сигналы: .,

dV_yi/dt, dω_zi/dt; блок формирования правой части уравнения математической модели боковой скорости:

блок формирования правой части уравнения математической модели угловой скорости:

блок формирования невязок канала боковой скорости:

блок формирования невязок канала угловой скорости:

блок формирования коррекции оценок гидродинамических коэффициентов в канале боковой скорости:

блок формирования коррекции оценок гидродинамических коэффициентов в канале угловой скорости:

блок памяти, содержащий оценки гидродинамических коэффициентов судна a_11,i, a_12,i, a_13,i, a_21,i, a_22,i, a_23,i и элементы ковариационной матрицы: P_11,i, P_12,i, P_13,i, P_22,i, P_23,i, P_33,i;

блок сравнения, формирующий модули разностей гидродинамических коэффициентов судна, используя сигналы из блока памяти: a_11,i, a_12,i, a_13,i, a_21,i, a_22,i, a_23,i и из блоков формирования коррекции гидродинамических коэффициентов каналов боковой и угловой скоростей: a_11,i+1, a_12,i+1, a_13,i+1, a_21,i+1, a_22,i+1, a_23,i+1. В блоке сравнения производится сравнение модулей разности с заданными допустимыми значениями - ε_ij:

Для решения поставленных задач вводят блок формирования коэффициентов усиления в процессе идентификации гидродинамических коэффициентов судна:

и блок формирования коррекции элементов ковариационной матрицы:

Обеспечить правильное функционирование всех рассмотренных выше блоков возможно, если выполнить все связи между ними в соответствии с фиг.1.

Если все шесть модулей разности, сформированные в блоке сравнения:

меньше допустимых значений ε_ij, то полученные оценки гидродинамических коэффициентов, в блоке формирования коррекции оценок гидродинамических коэффициентов в канале боковой скорости - V_y и блоке формирования коррекции оценок гидродинамических коэффициентов в канале угловой скорости - ω_z близки к истинным значениям искомых параметров математической модели движения судна в данный момент времени плавания, если же хотя бы одно из шести условий, полученных в блоке сравнения, не удовлетворяется, то шесть элементов ковариационной матрицы P_11,i+1, P_12,i+1, P_13,i+1, P_22,i+1, P_23,i+1, P_33,i+1 из блока формирования коррекции элементов ковариационной матрицы вводят в блок памяти взамен шести элементов ковариационной матрицы P_11,i, P_12,i, P_13,i, P_22,i, P_23,i, P_33,i.. Три оценки гидродинамических коэффициентов a_11,i+1, a_12,i+1, a_13,i+1 из блока формирования коррекции оценок гидродинамических коэффициентов в канале боковой скорости - V_y и три оценки гидродинамических коэффициентов a_21,i+1, a_22,i+1, a_23,i+1 из блока формирования коррекции оценок гидродинамических коэффициентов в канале угловой скорости - ω_z вводят в блок памяти взамен a_11,i, a_12,i, a_13,i, a_21,i, a_22,i, a_23,i.

При поступлении новых измерений через интервал времени Δt рассмотренный выше процесс уточнения гидродинамических коэффициентов вновь повторяется. По истечении «n» таких циклов идентификации, когда выполнятся все условия сравнения полученные значения оценок гидродинамических коэффициентов будут соответствовать искомым, т.е. определение гидродинамических коэффициентов математической модели движения судна успешно заканчивается.

Построение и работа системы определения параметров математической модели движения судна

Блок-схема системы идентификации приведена на фиг.1 и включает: 1 - задатчик идентификационных маневров управления движением судна; 2 - судно; 3 - измерительный блок (включающий датчики бокового ускорения dV_y/dt, боковой скорости хода V_y, продольной скорости V_x; угловой скорости ω_z, угла перекладки руля δ и углового ускорения dω_z/dt); 4 и 5 - блоки формирования правых частей математической модели боковой скорости судна - V_y и модели угловой скорости судна - ω_z; 6 и 7 - блоки формирования невязок каналов боковой и угловой скоростей судна; 8 и 9 - блоки коррекции гидродинамических коэффициентов в каналах боковой и угловой скоростей; 10 - блок формирования коэффициентов усиления в процессе идентификации гидродинамических коэффициентов; 11 - блок коррекции элементов ковариационной матрицы; 12 - блок памяти; 13 - блок сравнения.

Рассматриваемая система может быть реализована как с применением аналоговых счетно-решающих элементов, так и цифровых (последние предпочтительней). Измерительный блок следует оснастить датчиками с точностью не ниже 2%.

Рассмотрим процесс формирования уравнений для определения (корректировки) гидродинамических коэффициентов математической модели движения судна.

Процесс вычисления оценок гидродинамических коэффициентов начинается с задания:

- начальных значений гидродинамических коэффициентов (в блоке памяти 12):

a_11,i=0., a_12,i=0., a_13,i=0., a_21,i=0., a_22,i=0., a_23,i=0,

- начальных значений элементов ковариационной матрицы

P_11,i=P_22,i=P_33,i=10⁴, P_12,i=P_13,i=P_23,i=0 (в блоке-памяти 12),

- идентификационных маневров судна, которые формируются в задатчике идентификационных маневров движения судна 1.

Формирование двух каналов получения оценок гидродинамических коэффициентов: а) a_11,i, a_12,i, a_13,i и б) a_21,i, a_22,i, a_23,i.

а. Сигналы с блока измерения 3 поступают на первый вход блока формирования правой части математической модели боковой скорости судна V_y 4, на второй вход которого поступают из блока памяти 12 гидродинамические коэффициенты a_11,i, a_12,i, a_13,i. В блоке 4 формируется сигнал, описывающий правую часть уравнения боковой скорости V_y:

С блока измерения 3 сигналы поступают на первый вход блока 10, на второй вход которого из блока памяти 12 поступают элементы ковариационной матрицы P_11,i, P_12,i, P_13,i, P_22,i, P_23,i, P_33,i. В блоке 10 формируются коэффициенты усиления процесса идентификации гидродинамических коэффициентов K_1i, K_2i, K_3i.

С выходов блоков 3, 4 и 10 сигналы: dV_yi/dt, и K_1i, K_2i, K_3i поступают на вход блока невязок канала боковой скорости - V_y 6, где формируют невязки:

Невязки, сформированные по зависимости (2) из блока 6, поступают на первый вход блока коррекции гидродинамических коэффициентов 8, на второй вход которого поступают гидродинамические коэффициенты a_11,i, a_12,i, a_13,i из блока памяти 12. В блоке 8 формируют обновленные гидродинамические коэффициенты:

Гидродинамические коэффициенты, сформированные по зависимости (3) в блоке 8, вводятся в блок сравнения 13.

б. Сигналы снимаемые с блока измерения 3, поступают на первый вход блока формирования правых частей математической модели углового движения - ω_z 5, на второй вход которого поступают из блока памяти 12 гидродинамические коэффициенты a_21,i, a_22,i, a_23,i. На выходе блока 5 формируется сигнал, описывающий правую часть уравнения углового движения - ω_z:

С выходов блоков 3, 5 и 10 сигналы: dω_zi/dt, и K_1i, K_2i, K_3i поступают на вход блока невязок канала угловой скорости 7, где формируют невязки:

Невязки с выхода блока 7. поступают на вход блока коррекции гидродинамических коэффициентов 9, на второй вход которого из блока памяти 12 поступают гидродинамические коэффициенты a_21,i, a_22,i, a_23,i.

В блоке 9 формируют обновленные гидродинамические коэффициенты:

Гидродинамические коэффициенты, сформированные по зависимости (4) в блоке 9, вводятся в блок сравнения 13. В блоке сравнения 13 формируются модули разностей обновленных гидродинамических коэффициентов: a_11,i+1, a_12,i+1, a_13,i+1, a_21,i+1, a_22,i+1, a_23,i+1 и гидродинамических коэффициентов: a_11,i, a_12,i, a_13,i, a_21,i, a_22,i, a_23,i (вводят из блока памяти 12):

Если все разности (5) и (5a) не выходят из заданной точностной трубки, то процесс идентификации считается законченным, а полученные коэффициенты: a_11,i+1, a_12,i+1, a_13,i+1, a_21,i+1, a_22,i+1, a_23,i+1 соответствуют истинным значениям гидродинамических коэффициентов математической модели движения в данный момент времени.

Если хотя бы одна из зависимостей (5) или (5a) не удовлетворяется, то в блок памяти 12 вместо (старых) значений гидродинамических коэффициентов: a_11,i, a_12,i, a_13,i, a_21,i, a_22,i, a_23,i заносятся новые: a_11,i+1, a_12,i+1, a_13,i+1, a_21,i+1, a_22,i+1, a_23,i+1 (из блока 13).

С измерительного блока 3 сигналы поступают на первый вход блока коррекции элементов ковариационной матрицы 11, на второй и третий входы которого поступают коэффициенты усиления невязок процесса идентификации гидродинамических коэффициентов K_1i, K_2i, K_3i из блока 10 и элементы ковариационной матрицы P_11,i+1, P_12,i+1, P_13,i+1, P_22,i+1, P_23,i+1, P_33,i+1 из блока 12. На выходе блока 11 формируют обновленные элементы ковариационной матрицы:

где Элементы ковариационных матриц вводят в блок памяти 12.

Затем через интервал времени Δt весь рассмотренный выше цикл уточнения гидродинамических коэффициентов вновь повторяется. Через «n» циклов идентификации, когда выполнятся все условия (5) и (5а), полученные значения оценок гидродинамических коэффициентов будут соответствовать искомым, таким образом (в данный момент времени) идентификация гидродинамических коэффициентов математической модели движения судна успешно заканчивается.

Результаты моделирования

На фиг.2 и 3 представлены оценки и истинные значения гидродинамических коэффициентов математической модели судна «Сиберяков» a₁₁, a₁₂, a₁₃, и, a₂₁, a₂₂, a₂₃ при скорости судна V_x=5 m/c с использованием идентификационного режима «зигзаг».

Из фигур следует, что процесс корректировки оценок гидродинамических коэффициентов занимает около восьми секунд (расхождение восстановленных оценок гидродинамических коэффициентов от истинных значений не более 5%).

Изобретение относится к области судовождения - автоматическому управлению движением судна. Система определения гидродинамических коэффициентов математической модели движения судна содержит задатчик идентификационных маневров управления движением судна, объект управления, а также блок формирования коэффициентов усиления в процессе идентификации гидродинамических коэффициентов судна. Блок измерения включает датчики: бокового ускорения, боковой скорости судна, продольной скорости, угловой скорости, угла перекладки руля, углового ускорения. Блок памяти содержит текущие оценки гидродинамических коэффициентов судна и элементы ковариационной матрицы. Достигается уточнение гидродинамических коэффициентов математической модели движения судна, повышение качества автоматического управления движения, повышение безопасности проводки судна в узкостях, снижение нагрузки рулевого привода при сильном волнении. 3 ил.

Система определения гидродинамических коэффициентов математической модели движения судна, содержащая задатчик идентификационных маневров управления движением судна; объект управления; блок измерения, включающий датчики: бокового ускорения - dV_yi/dt, боковой скорости судна - V_yi, продольной скорости - V_xi, угловой скорости - ω_zi, угла перекладки руля - δ_i, углового ускорения - dω_zi/dt, в блоке измерения формируются сигналы:
V_xiV_yi…,V_xiω_zi…,V²_xiδ_i…,V²_xiV²_yi…,V²_xiV_yiω_zi…,V²_xiω²_zi…,V³_xiV_yiδ_i…,V⁴ _xiδ²_i, dV_yi/dt, dω_zi/dt, V_yi, V_xi, ω_zi, δ_i; блок памяти содержит текущие оценки гидродинамических коэффициентов судна: a_11,i, a_12,i, a_13,i, a_21,i, a_22,i, a_23,i и элементы ковариационной матрицы: P_11,i, P_12,i, P_13,i, P_22,i, P_23,i, P_33,i;
блок формирования правой части математической модели боковой скорости: dV_yi/dt = a_11,iV_xiV_yi+a_12,iV_xiω_zi+a_13,iV²_xiδ_i;
блок формирования правой части математической модели угловой скорости: dω_zi/dt = a_21,iV_xiV_yi +a_22,iV_xiω_zi +a_23,iV²_xiδ_i;
блок формирования невязок канала боковой скорости:
ν_v1i = K_1i (dV_yi/dt - a_11,iV_xiV_yi - a_12,iV_xiω_zi - a_13,iV²_xiδ_i),
ν_v2i = K_2i (dV_yi/dt - a_11,iV_xiV_yi - a_12,iV_xiω_zi - a_13,iV²_xiδ_i),
ν_v3i = K_3i (dV_yi/dt - a_11,iV_xiV_yi - a_12,iV_xiω_zi - a_13,iV²_xiδ_i);
блок формирования невязок канала угловой скорости:
ν_ω1i = K_1i (dω_zi/dt - a_21,iV_xiV_yi - a_22,iV_xiω_zi - a_23,iV²_xiδ_i),
ν_ω2i = K_2i (dω_zi/dt - a_21,iV_xiV_yi - a_22,iV_xiω_zi - a_23,iV²_xiδ_i),
ν_ω3i = K_3i (dω_zi/dt - a_21,iV_xiV_yi - a_22,iV_xiω_zi - a_23,iV²_xiδ_i);
блок формирования коррекции оценок гидродинамических коэффициентов в канале боковой скорости:
a_11,i+1 = a_11,i + K_1i (dV_yi/dt - a_11,iV_xiV_yi - a_12,iV_xiω_zi - a_13,iV²_xiδ_i),
a_12,i+1= a_12,i + K_2i (dV_yi/dt - a_11,iV_xiV_yi - a_12,iV_xiω_zi - a_13,iV²_xiδ_i),
a_13,i+1 = a_13,i + K_3i (dV_yi/dt - a_11,iV_xiV_yi - a_12,iV_xiω_zi - a_13,iV²_xiδ_i);
блок формирования коррекции оценок гидродинамических коэффициентов в канале угловой скорости:
a_21,i+1 = a_21,i + K_1i (dω_zi/dt - a_21,iV_xiV_yi - a_22,iV_xiω_zi - a_23,iV²_xiδ_i),
a_22,i+1 = a_22,i + K_2i (dω_zi/dt - a_21,iV_xiV_yi - a_22,iV_xiω_zi - a_23,iV²_xiδ_i),
a_23,i+1 = a_231,i + K_3i (dω_zi/dt - a_21,iV_xiV_yi - a_22,iV_xiω_zi - a_23,iV²_xiδ_i);
блок сравнения - формирует модули разностей гидродинамических коэффициентов судна, которые поступают:
- из блока памяти a_11,i, a_12,i, a_13,i, a_21,i, a_22,i, a_23,i;
- из блоков формирования коррекции гидродинамических коэффициентов канала боковой скорости: a_11,i+1, a_12,i+1, a_13,i+1;
- из блоков формирования коррекции гидродинамических коэффициентов канала угловой скорости: a_21,i+1, a_22,i+1, a_23,i+1;
для сравнения с допустимыми значениями - ε_ij:
| a_11,i+1 - a_11,i | ≤ ε₁₁, | a_12,i+1 - a_12,i | ≤ε₁₂, | a_13,i+1 - a_13,i | ≤ε_13, (А)
| a_21,i+1 - a_21,i | ≤ ε₂₁, | a_22,i+1 - a_22,i | ≤ε₂₂, | a_23,i+1 - a_23,i | ≤ε₂₃;
отличающаяся тем, что содержит блок формирования коэффициентов усиления в процессе идентификации гидродинамических коэффициентов судна:
K_1i = P_11,iV_xiV_yi + P_12,iV_xiω_zi+ P_13,iV²_xiδ_i,
K_2i = P_12,iV_xiV_yi + P_22,iV_xiω_zi+ P_23,iV²_xiδ_i,
K_3i = P_13,iV_xiV_yi + P_23,iV_xiω_zi+ P_33,iV²_xiδ_i;
и блок формирования коррекции элементов ковариационной матрицы
P_11,i+1 = P_11,i - K²_1i / r_i,
P_12,i+1 = P_12,i - K_1i - K_2i / r_i,
P_13,i+1 = P_13,i - K_1i - K_3i / r_i,
P_22,i+1 = P_22,i - K²_2i / r_i,
P_23,i+1 = P_23,i - K_2i - K_3i / r_i,
P_33,i+1 = P_33,i - K²_3i / r_i;
где
r_i=V²_xiV²_yiP_11,i+2V²_xiV_yiω_ziP_12,i+2V³_xiV_yiδ_iP_13,i+V²_xiω_zi²P_22,i+2V³_xiV_yiδ_iP_23,i+ +V⁴ _xiδ²_i +1;
если все условия (А), формируемые в блоке сравнения, удовлетворяются, то полученные оценки гидродинамических коэффициентов в блоке формирования коррекции оценок гидродинамических коэффициентов в канале боковой скорости - V_y и блоке формирования коррекции оценок гидродинамических коэффициентов в канале угловой скорости - ω_z близки к искомым значениям, если же хотя бы одно из шести условий (А), полученных в блоке сравнения, не удовлетворяется, то шесть элементов ковариационной матрицы P_11,i+1, P_12,i+1, P_13,i+1, P_22,i+1, P_23,i+1, P_33,i+1 из блока формирования коррекции элементов ковариационной матрицы вводят в блок памяти взамен находившихся в блоке памяти шести элементов ковариационной матрицы P_11,i, P_12,i, P_13,i, P_22,i, P_23,i, P_33,i и три оценки гидродинамических коэффициентов a_11,i+1, a_12,i+1, a_13,i+1 из блока формирования коррекции оценок гидродинамических коэффициентов в канале боковой скорости - V_y и три оценки гидродинамических коэффициентов a_21,i+1, a_22,i+1, a_23,i+1 из блока формирования коррекции оценок гидродинамических коэффициентов в канале угловой скорости - ω_z вводят в блок памяти взамен находившихся в блоке памяти: a_11,i, a_12,i, a_13,i и a_21,i, a_22,i, a_23,i;
через интервал времени Δt в системе процесс коррекции гидродинамических коэффициентов a_11,i+1, a_12,i+1, a_13,i+1, a_21,i+1, a_22,i+1, a_23,i+1 и элементов ковариационной матрицы P_11,i+1, P_12,i+1, P_13,i+1, P_22,i+1, P_23,i+1, P_33,i+1 повторяется.