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

Описание патента на изобретение RU2535777C1

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

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

,

где Vx, Vyz, ω, φ - линейные скорости судна продольная и поперечная, угловая скорость, угол курса,

δ - угол перекладки руля,

a iij - неизвестные параметры математической модели движения судна (подлежащие уточнению гидродинамические коэффициенты a11, a12, a13, a21, a22, a23),

ζ1, ζ2, ζ3 - случайные входные помехи с нулевыми средними и известными ковариационными матрицами M[i(t)]=0 и cov ( i ( t ) i T ( τ ) ) = Q i ( t ) δ ( t τ ) .

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

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

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

Недостатки:

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

2. низкая точность уточнения параметров гидродинамических коэффициентов мат. модели;

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

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

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

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

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

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

- угловой скорости ω, курса судна ϕ, угла перекладки руля δ, первый сумматор и блок задания маневра идентификации - ϕзд, вход которого подключен к первому входу рулевого привода, ко второму входу которого подключен выход первого сумматора, к трем входам первого сумматора подключены выходы трех датчиков: угловой скорости ω, курса судна ϕ, угла перекладки руля δ, в рулевом приводе формируется закон управления рулем:

зд./dt=Кϕ(ϕ-ϕзд)+Kωω-Kδδ,

где ϕ - текущий курс судна, от датчика курса судна ϕ,

ϕзд. - заданный курс, из блока задания маневра идентификации ϕзд,

ω - угловая скорость судна, от датчика угловой скорости ω,

δ - угол перекладки руля, от датчика угла перекладки руля δ,

зд./dt - заданная скорость перекладки руля.

Система дополнительно содержит блок памяти, девять сумматоров, два блока суммирования, десять множителей, блок сравнения, датчики: боковой скорости Vy, скорости хода судна Vx, углового ускорения dω/dt и бокового ускорения dVy/d, выход последнего подключен к первому входу первого блока суммирования, датчик боковой скорости Vy через первый множитель подключен к входу второго множителя, ко второму входу которого подключен гидродинамический коэффициент a11 из блока памяти, выход второго множителя подключен к первому входу второго сумматора, ко второму входу первого множителя подключен датчик скорости хода Vx, датчик угловой скорости ω через третий множитель подключен к входу четвертого множителя, выход четвертого множителя подключен к второму входу второго сумматора, ко второму входу третьего множителя подключен датчик скорости хода Vx, ко второму входу четвертого множителя подключен гидродинамический коэффициент a12 с блока памяти, датчик угла перекладки руля δ через пятый множитель подключен к входу шестого множителя, выход шестого множителя подключен к третьему входу второго сумматора, ко второму входу пятого множителя подключен выход седьмого множителя, к обоим входам которого подключен датчик скорости хода Vx, ко второму входу шестого множителя подключен гидродинамический коэффициент a13 с выхода блока памяти, во втором сумматоре формируется правая часть первого уравнения математической модели движения судна:

a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ,

где VxVy - продольная и поперечная скорость движения судна, поступают от датчиков Vx и Vy;

ω - угловая скорость, поступает от датчика ω;

δ - угол перекладки руля, поступает от датчика δ,

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

d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ,

которая через блок коэффициента усиления идентификатора Ka11 подключается к первому входу третьего сумматора, ко второму входу которого подключен гидродинамический коэффициент a11 с выхода блока памяти, в третьем сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 11 _ .1 :

a _ 11 _ .1 = a 11 + K a 11 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ,

выход третьего сумматора подключен к первому входу блока сравнения, первый вход четвертого сумматора через блок коэффициента усиления идентификатора Ka12. подключается к выходу первого блока суммирования, ко второму входу четвертого сумматора подключен гидродинамический коэффициент a12 с блока памяти, в четвертом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 12.1 :

a _ 12.1 _ = a 12 + K a 12 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ,

выход четвертого сумматора подключен к второму входу блока сравнения, первый вход пятого сумматора через блок коэффициента усиления идентификатора Ka13. подключен к выходу первого блока суммирования, к второму входу пятого сумматора подключен гидродинамический коэффициент a13 с выхода блока памяти, в пятом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 13.1 :

a _ 13.1 _ = a 13 + K a 13 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ,

выход пятого сумматора подключается к третьему входу блока сравнения, в блоке сравнения формируют модули разности корректированных оценок гидродинамических коэффициентов a _ 1 _ i , полученных в данном цикле, и коэффициентов a1i.0 предыдущего цикла вычисления гидродинамических коэффициентов:

| a _ 11 _ .1 a 11 0 | , | a _ 12 _ .1 a 12 0 | , | a _ 13 _ .1 a 13 0 | ,

где a11 0, a12 0, a13 0 - гидродинамические коэффициенты предыдущего цикла вычислений, вводятся в блок сравнения из блока памяти, используя модули разностей в блоке сравнения формируют три неравенства:

| a _ 1 j _ .1 a 1 j .0 | , <C2, где j=1, 2, 3

выход датчика углового ускорения dω/dt подключен к первому входу второго блока суммирования, ко второму входу которого через шестой сумматор и множители подключены:

- датчик боковой скорости Vy через первый множитель и восьмой множитель (ко второму входу которого подключен гидродинамический коэффициент: a _ 21 с блока памяти),

- датчик угловой скорости ω через третий множитель и девятый множитель (ко второму входу которого подключен гидродинамический коэффициент: a _ 22 с блока памяти),

- датчик скорости хода Vx через два входа седьмого множителя, пятый множитель, ко второму входу которого подключен датчик перекладки руля δ, и десятый множитель, ко второму входу которого подключен гидродинамический коэффициент: a _ 23 (с блока памяти), на выходе второго блока суммирования формируется невязка:

d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ,

которая через блок коэффициента усиления идентификатора Ka21 подключается к входу седьмого сумматора, ко второму входу которого подключен гидродинамический коэффициент: a _ 21 с блока памяти,

в седьмом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 21.1 :

a _ 21.1 = : a _ 21 + K a 21 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ,

выход седьмого сумматора подключается к четвертому входу блока сравнения, выход второго блока суммирования через блок коэффициента усиления идентификатора Ka22 подключается к входу восьмого сумматора, ко второму входу которого подключен гидродинамический коэффициент: a _ 22. с блока памяти, в восьмом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 22.1 :

a _ 22.1 = : a _ 22 + K a 22 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ,

выход восьмого сумматора подключен к пятому входу блока сравнения, выход второго блока суммирования через блок коэффициента усиления идентификатора Ka23. подключен к входу девятого сумматора, ко второму входу которого подключен гидродинамический коэффициент a _ 23 с блока памяти, в девятом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 23.1 :

a _ 23.1 = : a _ 23 + K a 23 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ,

выход девятого сумматора подключен к шестому входу блока сравнения, в блоке сравнения формируют модули разности корректированных гидродинамических коэффициентов a _ 2 i 1 , полученных в данном цикле, и a2i. 0 из предшествующего цикла вычисления

| a _ 21 _ .1 a 2 _ 1.0 | , | a _ 22 _ .1 a 12.0 | , | a _ 23. _ 1 a 23.0 | , где a21.0, a22.0, a23.0 - гидродинамические коэффициенты предыдущего цикла вычислений вводятся в блок сравнения из блока памяти;

при этом в блоке сравнения три модуля разности используют для формирования трех неравенств | a _ 2 j . _ 1 a 2 i .0 | < C 2 , если все шесть неравенств:

| a _ 1 j . _ 1 a 1 j .0 | , <C2 и | a _ 2 j . _ 1 a 2 i .0 | < C 2

удовлетворяются, то процесс идентификации всех гидродинамических коэффициентов математической модели успешно закончен, если хотя бы одно из шести неравенств не удовлетворяет условию | a _ j j . _ 1 a 2 i .0 | < C 2 ,

то оценки гидродинамических коэффициентов: a _ 11.1 , a _ 12.1 , a _ 13.1 , a _ 21.1 , a _ 22.1 , a _ 23.1 из блока сравнения водятся в блок памяти, через интервал времени Δt повторяется цикл формирования оценок гидродинамических коэффициентов.

Технический результат достигается благодаря:

- использованию полного набора измерителей фазового состояния судна,

(включая измерители линейных dVy/dt и угловых dω/dt ускорений),

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

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

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

.

где Vx, Vy, ω - продольная, боковая (линейные) и угловая скорости движения судна,

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

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

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

aij - неизвестные, подлежащие уточнению (шесть оценок гидродинамических коэффициентов: a _ 11 , a _ 12 , a _ 13 и a _ 21 , a _ 22 , a _ 23 . ) путем решения систем алгебраических уравнений.

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

Система включает: рулевой привод, датчики угловой скорости ω, курса судна ϕ угла перекладки руля δ, первый сумматор и блок задания маневра идентификации - ϕзд, вход которого подключен к первому входу рулевого привода, к второму входу которого подключен выход первого сумматора, к трем входам первого сумматора подключены выходы трех датчиков: угловой скорости ω, курса судна ϕ, угла перекладки руля δ, в рулевом приводе формируется закон управления рулем:

d δ з д . / d t = K φ ( φ φ з д ) + К ω ω К δ δ ( A 2 )

где ϕ - текущий курс судна, от датчика курса судна ϕ,

ϕзд. - заданный курс, из блока задания маневра идентификации ϕзд.,

ω - угловая скорость судна, от датчика угловой скорости ω,

δ - угол перекладки руля, от датчика угла перекладки руля δ,

зд./dt - заданная скорость перекладки руля.

Для реализации предложенного технического решения в систему введены: блок памяти, шесть блоков коэффициентов усиления идентификатора, второй-девятый сумматоры, два блока суммирования, первый-десятый множители, блок сравнения, датчики: боковой скорости Vy, скорости хода Vx, углового ускорения dω/dt и бокового ускорения dVy/dt, выход последнего подключен к первому входу первого блока суммирования, датчик боковой скорости Vy через первый множитель подключен к входу второго множителя, ко второму входу которого подключен гидродинамический коэффициент a11 из блока памяти, выход второго множителя подключен к первому входу второго сумматора, к второму входу первого множителя подключен датчик скорости хода Vx. Датчик угловой скорости ω через третий множитель подключен к входу четвертого множителя, выход четвертого множителя подключен к второму входу второго сумматора, к второму входу третьего множителя подключен датчик скорости хода Vx, к второму входу четвертого множителя подключен гидродинамический коэффициент a12 с блока памяти. Датчик угла перекладки руля δ через пятый множитель подключен к входу шестого множителя, выход шестого множителя подключен к третьему входу второго сумматора, к второму входу пятого множителя подключен выход седьмого множителя, к обоим входам которого подключен датчик скорости хода Vx, к второму входу шестого множителя подключен гидродинамический коэффициент a13 с выхода блока памяти, во втором сумматоре формируется правая часть первого уравнения математической модели движения судна (1):

a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ( 2 )

где VxVy - продольная и поперечная скорость движения судна, поступают от датчиков Vx и Vy;

ω - угловая скорость, поступает от датчика ω;

δ - угол перекладки руля, поступает от датчика δ,

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

d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ( 3 a )

которая через блок коэффициента усиления идентификатора Ka11 подключается к первому входу третьего сумматора, ко второму входу которого подключен гидродинамический коэффициент a11 с выхода блока памяти, в третьем сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 11 _ .1 :

a _ 11 _ .1 = a 11.0 + K a 11 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ( 4 a )

выход третьего сумматора подключен к первому входу блока сравнения.

Первый вход четвертого сумматора через блок коэффициента усиления идентификатора Ka12. подключается к выходу первого блока суммирования, к второму входу четвертого сумматора подключен гидродинамический коэффициент a12 с блока памяти, в четвертом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 12.1 :

a _ 12.1 _ = a 12 + K a 12 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ( 4 б )

выход четвертого сумматора подключен к второму входу блока сравнения, первый вход пятого сумматора через блок коэффициента усиления идентификатора Ka13. подключен к выходу первого блока суммирования, к второму входу пятого сумматора подключен гидродинамический коэффициент a13 с выхода блока памяти, в пятом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 13.1 :

a _ 13.1 _ = a 13 + K a 13 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ( 4 в )

выход пятого сумматора подключается к третьему входу блока сравнения, в блоке сравнения формируют модули разности корректированных оценок гидродинамических коэффициентов a _ 1 _ i 1 , полученных в данном цикле и коэффициентов a1i.0 предыдущего цикла вычисления гидродинамических коэффициентов:

| a _ 11 _ .1 a 11 0 | : | a _ 12 _ .1 a 12 0 | , | a _ 13 _ .1 a 13 0 | ( 5 ) .

где a11 0, a12 0, a13 0 - гидродинамические коэффициенты предыдущего цикла вычислений вводятся в блок сравнения из блока памяти, используя модули разностей в блоке сравнения формируют три неравенства:

| a _ 1 j _ .1 a 1 j .0 | , < C 2 ( 6 ) i . = 1,2,3 _

если все три неравенства (6) удовлетворяются, то процесс идентификации оценок гидродинамических коэффициентов a _ 111 _ , a _ 12 1 _ , a _ 13 1 _ завершен (для первого уравнения математической модели движения судна (1)).

Аналогичным образом определяются и коэффициенты a _ 21 , a _ 22 , a _ 23 (для второго уравнения (1)).

Выход датчика углового ускорения dω/dt подключен к входу второго блока суммирования 5, к входам которого через шестой сумматор и множители также подключены:

- датчик боковой скорости Vy через первый множитель и восьмой множитель (к второму входу которого подключен гидродинамический коэффициент: a _ 21 с блока памяти),

- датчик угловой скорости ω через третий множитель и девятый множитель (к второму входу которого подключен гидродинамический коэффициент: a _ 22 с блока памяти,

- датчик скорости хода Vx через седьмой множитель (к второму входу которого подключен этот же датчик скорости хода Vx), пятый множитель (к второму входу которого подключен датчик перекладки руля δ и десятый множитель (к второму входу которого подключен гидродинамический коэффициент: a _ 23. с блока памяти).

На выходе второго блока суммирования таким образом формируется невязка:

d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ( 3 б )

которая через блок коэффициента усиления идентификатора Ka21 подключается к входу седьмого сумматора, ко второму входу которого подключен гидродинамический коэффициент: a _ 21 с блока памяти,

В седьмом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 21.1 :

a _ 21.1 = : a _ 21.0 + K a 21 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ( 4 г )

выход седьмого сумматора подключается к четвертому входу блока сравнения.

Выход второго блока суммирования через блок коэффициента усиления идентификатора Ка22 подключается к входу восьмого сумматора, ко второму входу которого подключен гидродинамический коэффициент a _ 22. с блока памяти. В восьмом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 22.1 :

a _ 22.1 = : a _ 22..0 + K a 22 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ( 4 д ) .

выход восьмого сумматора подключен к пятому входу блока сравнения.

Выход второго блока суммирования через блок коэффициента усиления идентификатора Ka23 подключен к входу девятого сумматора, ко второму входу которого подключен гидродинамический коэффициент a _ 23 с блока памяти. В девятом сумматоре формируется оценка корректированного гидродинамического коэффициента a _ 23.1 :

a _ 23.1 = : a _ 23.0 + K a 23 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ( 4 e ) .

выход девятого сумматора подключен к шестому входу блока сравнения.

В блоке сравнения формируют модули разности корректированных гидродинамических коэффициентов a _ 2 i 1 , полученных в данном цикле и a 2 i . 0 в предыдущем цикле вычисления:

| a _ 21 _ .1 a 2 _ 1.0 | , | a _ 22 _ .1 a 12.0 | , | a _ 23. _ 1 a 23.0 | ( 5 a ) .

где a21.0, a22.0, a23.0 - гидродинамические коэффициенты предыдущего цикла вычислений вводятся в блок сравнения из блока памяти,

В блоке сравнения три модуля разности (5a) используют для формирования трех неравенств

| a _ 2 j . _ 1 a 2 i .0 | , < C 2 ( 6 a ) .

если все три неравенства (6а) удовлетворяются, то процесс идентификации величин оценок гидродинамических коэффициентов a _ 21.1 _ , a _ 22 1 _ , a _ 23 1 _ закончен (для второго уравнения математической модели движения судна (1)).

Если все модули неравенств (три модуля (6) и три модуля(6а) удовлетворяются то процесс идентификации всех гидродинамических коэффициентов математической модели (1) успешно завершен. Если хотя бы один из шести модулей разности не удовлетворяет условию (6) или (6а), то значения оценок гидродинамических коэффициентов: a _ 11.1 , a _ 12.1 , _ a _ 13.1 , a _ 21.1 , a _ 22.1 , a _ 23.1 из блока сравнения водят в блок памяти (вместо гидродинамических коэффициентов a _ 11. o , a _ 12. o , a _ 13. o , a _ 21. o , a _ 22.0 , a _ 23.0 ).

Через интервал времени Δt начинается следующий цикл формирования оценок гидродинамических коэффициентов a _ 11.2 , a _ 12.2 , a _ 13.2 , a _ 21.2 , a _ 22.2 , a _ 23.2 .

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

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

На фиг. приведена блок-схема системы идентификации параметров математической модели движения судна которая включает: рулевой привод - 1, объект управления - судно - 2, блок задания маневра идентификации ϕзд - 3, датчики: бокового ускорения dVy/dt - 4, боковой скорости Vy - 5, скорости хода судна Vx - 6, угловой скорости ω - 7, угла перекладки руля δ - 8, углового ускорения dω/dt - 9, первый-десятый множители: 10, 33, 12, 32, 13, 31, 11, 34, 35, 36, первый-девятый сумматоры: 30, 14, 25, 24, 23, 15, 26, 27, 28, первый - 37 и второй - 38 блоки суммирования, первый-шестой блоки коэффициентов усиления идентификатора Ka11…Ka23 - 18, 17, 16, 19, 20, 21, блок памяти - 22, блок сравнения - 29, датчик угла курса ϕ - 31.

Реализовать рассматриваемую систему следует используя элементы цифровой техники и штатные судовые устройства (рулевой привод, датчики спутниковой навигационной системы…)

Процесс идентификации гидродинамических коэффициентов математической модели движения судна начинается в момент времени to заданием прямоугольных периодических импульсов, которые формируются в блоке задания маневра идентификации - 3 и заданием начальных значений оценок гидродинамических коэффициентов: a _ 11 t o _ = 0 , a _ 12 t o = 0 , a _ 13 t o = 0 и a _ 21 t o = 0 , a _ 22 t o = 0 , a _ 23 t o = 0 . в блоке памяти - 22

Сигнал в виде прямоугольного импульса, амплитуда которого ϕзд. вводится на первый вход рулевого привода - 1, на второй вход которого вводятся сигналы с выхода первого сумматора 31. На вход первого сумматора - 30. подключены датчики: угла курса ϕ - 31, руля δ - 8 и угловой скорости ω - 7. В рулевом приводе - 1 формируется закон управления кормовым рулем:

d δ / d t = K φ ( φ φ з д ) + K ω ω + K δ δ ( A 2 )

Это приведет к отслеживанию судном угла курса ϕ=ϕзд, ϕзд, поступающего в рулевой привод - 1 с блока задания маневра идентификации ϕзд - 3.

В предложенной нами системе определяются оценки шести неизвестных гидродинамических коэффициентов математической модели движения судна ( a _ 11 a _ 23 ) (см. (1)).

Выход датчика (бокового) ускорения dVy/dt - 4 подключен к входу первого блока суммирования - 37, к входу которого также подключены:

- датчик боковой скорости Vy - 5, через первый множитель - 10 (ко второму входу которого подключен датчик скорости хода Vx - 6,) и второй множитель - 33 (к второму входу которого подключен гидродинамический коэффициент: a _ 11 с блока памяти - 22) и второй сумматор - 14,

- датчик угловой скорости ω - 7 через третий множитель - 12 (к второму входу которого подключен датчик скорости хода Vx - 6,) и четвертый множитель - 32 (к второму входу которого подключен гидродинамический коэффициент: a _ 12 с блока памяти - 22),

- датчик Vx - 6 через седьмой множитель - 11 (ко второму входу которого подключен этот же датчик скорости хода Vx - 6), пятый множитель 13 (ко второму входу которого подключен датчик угла перекладки руля δ - 8 и шестой множитель - 31 (к второму входу которого подключен гидродинамический коэффициент: a _ 13. с блока памяти - 22), на выходе первого блока суммирования - 37, таким образом формируется невязка:

d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ( 3 а )

Невязка вида (3а) с выхода первого блока суммирования - 37 через блок коэффициента усиления идентификатора Ka11 - 18 подключается к входу третьего сумматора - 25, ко второму входу которого подключен гидродинамический коэффициент: a _ 11 с блока памяти - 22. На выходе третьего сумматора - 25 формируется оценка корректированного гидродинамического коэффициента a _ 1 _ 1.1

a _ 11.1 = : a _ 11.0 + K a _ 11 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] , ( 4 а )

которую вводят в блок сравнения 29.

Невязка вида (3а) с выхода первого блока суммирования - 37 через блок коэффициента усиления идентификатора K a _ 12 - 17 подключена к входу четвертого сумматора - 24, ко второму входу которого подключен гидродинамический коэффициент: a _ 12 с блока памяти - 22.

На выходе четвертого сумматора - 24 формируется оценка корректированного гидродинамического коэффициента a _ 1 _ 2.1 :

a _ 1.2.1 = a _ 12.0 + K a _ 12 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] , ( 4 б ) .

которая поступает в блок сравнения 29.

Невязка вида (3а) с выхода первого блока суммирования - 37 через блок коэффициента усиления идентификатора - 6 подключается к входу пятого сумматора - 23, ко второму входу которого подключен гидродинамический коэффициент: a _ 13 с блока памяти - 22.

На выходе пятого сумматора - 23 формируется оценка корректированного гидродинамического коэффициента a _ 13 _ .1 :

a _ 13..1 = a _ 13.0 + K a _ 13 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] , ( 4 в ) ,

которая поступает в блок сравнения 29.

Аналогичным образом определяются и оценки коэффициентов a _ 21 , a _ 22 , a _ 23 . Выход датчика углового ускорения dω/dt - 9 подключен к первому входу второго блока суммирования - 38, ко второму входу которого через множители и шестой сумматор - 15 подключены:

- датчик боковой скорости Vy - 5 через первый множитель - 10 и восьмой множитель - 34 (к второму входу которого подключен гидродинамический коэффициент a _ 21 с блока памяти - 22,

- датчик угловой скорости ω - 7 через третий множитель - 12 и девятый множитель -35 (к второму входу которого подключен гидродинамический коэффициент: a _ 22 с блока памяти - 22,

- датчик угла перекладки руля δ - 8 через пятый множитель - 13 и десятый множитель - 36 (к второму входу которого подключен гидродинамический коэффициент: a _ 23. с блока памяти - 22. На выходе второго блока суммирования - 38 таким образом формируется невязка:

d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ( 3 б )

Выход второго блока суммирования 38 с невязкой вида (3б) через блок коэффициента усиления идентификатора Ka21 - 19 подключается к входу седьмого сумматора 26, ко второму входу которого подключен гидродинамический коэффициент: a _ 21 с блока памяти - 22. На выходе седьмого сумматора - 26 формируется оценка корректированного гидродинамического коэффициента a _ 21 _ .1.

a _ 21.1 = : a _ 21.0 + K a 21 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ( 4 г ) ,

которая поступает в блок сравнения 29.

Выход второго блока суммирования - 38 с невязкой вида (3б) через блок коэффициента усиления идентификатора Ka22 - 20 подключается к входу восьмого сумматора - 27, ко второму входу которого подключен гидродинамический коэффициент: a _ 22. с блока памяти - 22. На выходе восьмого сумматора - 27 формируется оценка корректированного гидродинамического коэффициента a _ 22 _ .1

a _ 22.1 = : a _ 22.0 + K a 22 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ( 4 д ) ,

которая поступает в блок сравнения 29.

Выход второго блока суммирования - 31 с невязкой вида (2a) через блок коэффициента усиления идентификатора Ka23 - 21 подключается к входу девятого сумматора - 28, ко второму входу которого подключен гидродинамический коэффициент: a _ 23 с блока памяти - 22.

На выходе девятого сумматора - 28 формируется оценка корректированного гидродинамического коэффициента a _ 23 _ .

a _ 23..1 = : a _ 2.3.0 + K 21 [ d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ] ( 4 е ) .

которая поступает в блок сравнения 29.

В блоке сравнения - 29 оценки гидродинамических коэффициентов a _ i j .1 с выхода сумматоров - 23-28 и шести оценок гидродинамических коэффициентов a _ i j 1 ( 0 ) из блока памяти - 22 используют для формирования модулей разности оценок гидродинамических коэффициентов:

| a _ 11.1 a _ 11.0 | | a _ 23.1 a _ 23.0 | ( 5 б ) .

Если все шесть модулей разности (56)удовлетворяют неравенствам:

| a _ i j .1 a _ i j .0 | < C i j , ( 6 б ) ,

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

Если хотя бы одна из шести невязок (5б) не удовлетворяет неравенству (6б), то полученные в блоках 23-28 новые значения оценок гидродинамических коэффициентов: a _ 11.1 , a _ 12.1 , a _ 13..1 , a _ 21.1 , a _ 22.1 , a _ 23..1 вводят через блок суммирования - 29 в блок памяти - 22 системы вместо a _ 11. o , a _ 12. o , a _ 13. o , a _ 21. o , a _ 22. o , a _ 23.. o и через интервал времени Δt процесс корректировки гидродинамических коэффициентов продолжается - повторяется весь рассмотренный выше цикл формирования невязок гидродинамических коэффициентов до момента времени mΔt, когда неравенства (6) и (6а) одновременно удовлетворяться.

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

На фиг. представлены оценки и истинные значения параметров модели судна a11, a12, b1=a13, a21, a22, b2=a23 при скорости судна Vx=5m/c с использованием идентификационного режима «зигзаг».

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

Похожие патенты RU2535777C1

название год авторы номер документа
ОТКАЗОУСТОЙЧИВАЯ СИСТЕМА АВТОМАТИЧЕСКОГО УПРАВЛЕНИЯ ДВИЖЕНИЕМ СУДНА 2013
  • Острецов Генрих Эразмович
RU2532000C1
СПОСОБ УПРАВЛЕНИЯ ДВИЖЕНИЕМ СУДНА ПО ЗАДАННОЙ ТРАЕКТОРИИ 2011
  • Острецов Генрих Эразмович
  • Клячко Лев Михайлович
  • Памухин Сергей Генрихович
RU2483973C2
Система управления движением судна с дублированием каналов курса и резервным управлением по курсу 2017
  • Острецов Генрих Эразмович
  • Памухин Сергей Генрихович
RU2660193C1
АВТОРУЛЕВОЙ С ОЦЕНКОЙ УГЛОВОЙ СКОРОСТИ 2004
  • Острецов Генрих Эразмович
RU2269451C1
СПОСОБ УПРАВЛЕНИЯ ДВИЖЕНИЕМ СУДНА С КОМПЕНСАЦИЕЙ МЕДЛЕННО МЕНЯЮЩИХСЯ ВНЕШНИХ ВОЗМУЩЕНИЙ И СИСТЕМА УПРАВЛЕНИЯ ДВИЖЕНИЕМ СУДНА С КОМПЕНСАЦИЕЙ МЕДЛЕННО МЕНЯЮЩИХСЯ ВНЕШНИХ ВОЗМУЩЕНИЙ 2014
  • Катенин Владимир Александрович
  • Чернявец Владимир Васильевич
  • Жильцов Николай Николаевич
  • Катенин Александр Владимирович
  • Чернявец Антон Владимирович
RU2564786C1
СПОСОБ АВТОМАТИЧЕСКОГО УПРАВЛЕНИЯ ДВИЖЕНИЕМ СУДНА С УЧЕТОМ ВОЛНЕНИЯ 2011
  • Острецов Генрих Эразмович
  • Памухин Сергей Генрихович
RU2499727C2
СПОСОБ УПРАВЛЕНИЯ ДВИЖЕНИЕМ СУДНА С КОМПЕНСАЦИЕЙ МЕДЛЕННО МЕНЯЮЩИХСЯ ВОЗМУЩЕНИЙ 2012
  • Острецов Генрих Эразмович
  • Тарасов Николай Николаевич
RU2492105C1
СИСТЕМА АВТОМАТИЧЕСКОГО УПРАВЛЕНИЯ СУДНОМ 2004
  • Клячко Л.М.
  • Острецов Г.Э.
  • Памухин С.Г.
RU2248914C1
УСТРОЙСТВО УПРАВЛЕНИЯ ДВИЖЕНИЕМ СУДНА 1998
  • Острецов Г.Э.
  • Памухин Ю.Г.
  • Клячко Л.М.
  • Дюжев Э.В.
RU2150409C1
СИСТЕМА УПРАВЛЕНИЯ ДВИЖЕНИЕМ КОРАБЛЯ 2006
  • Дорри Манучер Хабибуллаевич
  • Корчанов Виктор Михайлович
  • Острецов Генрих Эразмович
  • Попов Петр Валентинович
  • Рощин Александр Алексеевич
RU2305050C1

Иллюстрации к изобретению RU 2 535 777 C1

Реферат патента 2014 года СИСТЕМА ИДЕНТИФИКАЦИИ ГИДРОДИНАМИЧЕСКИХ КОЭФФИЦИЕНТОВ МАТЕМАТИЧЕСКОЙ МОДЕЛИ ДВИЖЕНИЯ СУДНА

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

Формула изобретения RU 2 535 777 C1

Система идентификации гидродинамических коэффициентов математической модели движения судна, содержащая рулевой привод, датчики: угловой скорости ω, курса судна ϕ, угла перекладки руля δ, первый сумматор и блок задания маневра идентификации ϕзд., вход которого подключен к первому входу рулевого привода, ко второму входу которого подключен выход первого сумматора, к трем входам первого сумматора подключены выходы трех датчиков: угловой скорости ω, курса судна ϕ, угла перекладки руля δ, в рулевом приводе формируется закон управления рулем:
зд./dt=Кϕ(ϕ-ϕзд.)+Kωω-Kδδ,
где ϕ - текущий курс судна, от датчика курса судна ϕ,
ϕзд. - заданный курс, из блока задания маневра идентификации ϕзд.,
ω - угловая скорость судна, от датчика угловой скорости ω,
δ - угол перекладки руля, от датчика угла перекладки руля δ,
зд./dt - заданная скорость перекладки руля,
отличающаяся тем, что дополнительно содержит блок памяти, девять сумматоров, два блока суммирования, десять множителей, блок сравнения, датчики: боковой скорости Vy, скорости хода судна Vx, углового ускорения dω/dt и бокового ускорения dVy/d, выход последнего подключен к первому входу первого блока суммирования, датчик боковой скорости Vy через первый множитель подключен к входу второго множителя, ко второму входу которого подключен гидродинамический коэффициент a11 из блока памяти, выход второго множителя подключен к первому входу второго сумматора, ко второму входу первого множителя подключен датчик скорости хода Vx, датчик угловой скорости ω через третий множитель подключен к входу четвертого множителя, выход четвертого множителя подключен ко второму входу второго сумматора, ко второму входу третьего множителя подключен датчик скорости хода Vx, ко второму входу четвертого множителя подключен гидродинамический коэффициент a12 с блока памяти, датчик угла перекладки руля δ через пятый множитель подключен к входу шестого множителя, выход шестого множителя подключен к третьему входу второго сумматора, ко второму входу пятого множителя подключен выход седьмого множителя, к обоим входам которого подключен датчик скорости хода Vx, ко второму входу шестого множителя подключен гидродинамический коэффициент a13 с выхода блока памяти, во втором сумматоре формируется правая часть первого уравнения математической модели движения судна:
a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ,
где VxVy - продольная и поперечная скорость движения судна, поступают от датчиков Vx и Vy;
ω - угловая скорость, поступает от датчика ω;
δ - угол перекладки руля, поступает от датчика δ,
выход второго сумматора подключен ко второму входу первого блока суммирования, на выходе которого формируется невязка:
d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ,
которая через блок коэффициента усиления идентификатора Ka11 подключается к первому входу третьего сумматора, ко второму входу которого подключен гидродинамический коэффициент a11 с выхода блока памяти, в третьем сумматоре формируется оценка корректированного гидродинамического коэффициента a 11.1:
a _ 11 _ .1 = a 11 + K a 11 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ,
выход третьего сумматора подключен к первому входу блока сравнения,
первый вход четвертого сумматора через блок коэффициента усиления идентификатора Ka12 подключается к выходу первого блока суммирования, ко второму входу четвертого сумматора подключен гидродинамический коэффициент a12 с блока памяти, в четвертом сумматоре формируется оценка корректированного гидродинамического коэффициента a 12.1:
a _ 12 _ .1 = a 12 + K a 12 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ,
выход четвертого сумматора подключен ко второму входу блока сравнения, первый вход пятого сумматора через блок коэффициента усиления идентификатора Ka13 подключен к выходу первого блока суммирования, ко второму входу пятого сумматора подключен гидродинамический коэффициент a13 с выхода блока памяти, в пятом сумматоре формируется оценка корректированного гидродинамического коэффициента a 13.1:
a _ 13 _ .1 = a 13 + K a 13 [ d V y / d t ( a _ 11 V x V y + a _ 12 V x ω + a _ 13 V x V x δ ) ] ,
выход пятого сумматора подключается к третьему входу блока сравнения, в блоке сравнения формируют модули разности корректированных оценок, гидродинамических коэффициентов a 1i, полученных в данном цикле и коэффициентов a1i.0 - предыдущего цикла вычисления гидродинамических коэффициентов:
| a _ 11 _ .1 a 11 0 | , | a _ 12 _ .1 a 12 0 | , | a _ 13 _ .1 a 13 0 | ,
где a11 0, a12 0, a13 0 - гидродинамические коэффициенты предыдущего цикла вычислений, вводятся в блок сравнения из блока памяти, используя модули разностей в блоке сравнения, формируют три неравенства:
| a _ 1 j _ .1 a 1 j .0 | , <C2, где j=1, 2, 3
выход датчика углового ускорения dω/dt, подключен к первому входу второго блока суммирования, ко второму входу которого через шестой сумматор и множители подключены:
- датчик боковой скорости Vy через первый множитель и восьмой множитель (ко второму входу которого подключен гидродинамический коэффициент a 21 с блока памяти),
- датчик угловой скорости ω через третий множитель и девятый множитель (ко второму входу которого подключен гидродинамический коэффициент a 22 с блока памяти),
- датчик скорости хода Vx через два входа седьмого множителя, пятый множитель, ко второму входу которого подключен датчик перекладки руля δ и десятый множитель, ко второму входу которого подключен гидродинамический коэффициент a 23 (с блока памяти), на выходе второго блока суммирования формируется невязка:
d ω / d t ( a _ 21 V x V y + a _ 22 V x ω + a _ 23 V x V x δ ) ,
которая через блок коэффициента усиления идентификатора Ka21, подключается к входу седьмого сумматора, ко второму входу которого подключен гидродинамический коэффициент a 21 с блока памяти,
в седьмом сумматоре формируется оценка корректированного гидродинамического коэффициента a 21.1:
a 21.1 = a 21 + Ka21 [dω/dt - (a 21VxVy + a 22Vx ω + a 23VxVx δ)],
выход седьмого сумматора подключается к четвертому входу блока сравнения, выход второго блока суммирования через блок коэффициента усиления идентификатора Ka22 подключается к входу восьмого сумматора, ко второму входу которого подключен гидродинамический коэффициент a 22 с блока памяти, в восьмом сумматоре формируется оценка корректированного гидродинамического коэффициента a 22.1:
a 22.1 = a 22 + Ka22 [dω/dt - (a 21VxVy + a 22Vx ω + a 23VxVx δ)],
выход восьмого сумматора подключен к пятому входу блока сравнения, выход второго блока суммирования через блок коэффициента усиления идентификатора Ka23 подключен к входу девятого сумматора, ко второму входу которого подключен гидродинамический коэффициент a 23 с блока памяти, в девятом сумматоре формируется оценка корректированного гидродинамического коэффициента a 23.1:
a 23.1 = a 23 + Ka23 [dω/dt - (a 21VxVy + a 22Vx ω + a 23VxVx δ)],
выход девятого сумматора подключен к шестому входу блока сравнения,
в блоке сравнения формируют модули разности корректированных гидродинамических коэффициентов a 2i.1, полученных в данном цикле и a2i.0 из предшествующего цикла вычисления
| a _ 21 _ .1 a 2 _ 1.0 | , | a _ 22 _ .1 a 12.0 | , | a _ 23. _ 1 a 23.0 | , где a21.0, a22.0, a23.0 - гидродинамические коэффициенты предыдущего цикла вычислений вводятся в блок сравнения из блока памяти;
при этом в блоке сравнения три модуля разности используют для формирования трех неравенств: | a _ 2 j . _ 1 a 2 i .0 | < C 2 , если все шесть неравенств:
| a _ 1 j . _ 1 a 1 j .0 | , <C2 и | a _ 2 j . _ 1 a 2 i .0 | < C 2
удовлетворяются, то процесс идентификации всех гидродинамических коэффициентов математической модели успешно закончен, если хотя бы одно из шести неравенств не удовлетворяет условию | a _ 2 j . _ 1 a 2 i .0 | < C 2 , то оценки гидродинамических коэффициентов: a _ 11.1 , a _ 12.1 , a _ 13.1 , a _ 21.1 , a _ 22.1 , a _ 23.1 из блока сравнения вводятся в блок памяти, через интервал времени Δt повторяется цикл формирования оценок гидродинамических коэффициентов.

Документы, цитированные в отчете о поиске Патент 2014 года RU2535777C1

СПОСОБ ЭКСПЕРИМЕНТАЛЬНОГО ОПРЕДЕЛЕНИЯ КОЭФФИЦИЕНТОВ МАТЕМАТИЧЕСКОЙ МОДЕЛИ ДВИЖЕНИЯ СУДНА 1999
  • Острецов Г.Э.
  • Клячко Л.М.
  • Дюжев Э.В.
RU2151713C1
СПОСОБ ПАРАМЕТРИЧЕСКОЙ ИДЕНТИФИКАЦИИ МАТЕМАТИЧЕСКОЙ МОДЕЛИ СУДНА 2010
  • Юдин Юрий Иванович
  • Пашенцев Сергей Владимирович
RU2444043C1
Приспособление для выдавливания и дальнейшего транспортирования формовочных комов 1983
  • Еберхард Енде
  • Хеллфрид Кестнер
  • Вольфганг Шаде
  • Вольфганг Леве
SU1416268A1

RU 2 535 777 C1

Авторы

Острецов Генрих Эразмович

Тарасов Николай Николаевич

Даты

2014-12-20Публикация

2013-08-09Подача