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

Предлагаемое изобретение относится к области судовождения - автоматическому управлению движением судна по заданному маршруту.

Известны системы автоматического управления движением судна (Острецов Г.Э., Клячко Л.М. Методы автоматизации управления движением корабля. Физматлит 2009 г., например, патент RU 2240953 С1, БИ №33, 27.11.2004 г.). Система управления движением судна основана на использовании информации от приемника спутниковой навигационной системы, датчика угловой скорости, блока заданного значения путевого угла (или угла курса) и сумматора, в котором по сигналам текущего путевого угла, заданного путевого угла, угловой скорости судна формируется сигнал для управления рулевым приводом судна.

Известна также система автоматического управления движением (САУД) судна (патент RU 2292289 С1, БИ №3, 27.01.2007 г., принятый нами в качестве прототипа), в которой автоматическое управление движением судна осуществляется (аналогично описанному выше) с использованием рулевого привода, блока выработки угловой скорости, датчика руля, блоков текущего и заданного путевого угла (или угла курса) и формирователя закона управления - сумматора.

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

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

Появление современных цифровых вычислительных средств, спутниковой навигации позволило широко применять сложные законы управления с развитой логикой, т.е. существовавшие ранее технологические ограничения при построении архисложных САУД сейчас отсутствуют.

Известные САУД:

- не обеспечивают отказоустойчивое управление,

- создают недопустимые перегрузки рулевого привода при волнении на море,

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

- при сильном волнении на море снижают скорость хода судна (и даже требуют отключения САУД для перехода на ручное управление судном).

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

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

- подсистемы выявления сбоя в САУД с автоматическим восстановлением заданного режима плавания путем исключения аварийного блока САУД.

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

- использования фильтров для формирования оценок измеряемых навигационных параметров,

- использования подсистемы диагностики (причем при выявлении сбоя какого-либо элемента САУД автоматически осуществляется перестройка архитектуры САУД для сохранения заданного режима плавания),

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

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

- использования дублирующих фильтров оценок угловой скорости и поперечной линейной скорости ( $${\underset{\_}{\omega }}_2$$ , $${\underset{\_}{V_z}}_2$$ ),

- формирования сигнала оценки угловой скорости - $$\underset{\_}{\omega }$$ с учетом оценки поперечной линейной скорости - $$\underset{\_}{V_z}$$ ,

- формирования сигнала оценки поперечной линейной скорости - $$\underset{\_}{V_z}$$ c учетом оценки угловой скорости - $$\underset{\_}{\omega }$$ .

Предлагаемая отказоустойчивая система управления движением судна содержит датчик руля - δ, датчик угловой скорости - ω₁, датчик скорости хода - V_x, датчик угла курса ϕ₁, задатчик угла курса ϕ_зд, сумматор, рулевой привод, датчик руля - δ, который подключен к первому входу сумматора, ко второму входу сумматора подключен задатчик угла курса - ϕ_зд, выход сумматора подключен к входу рулевого привода. Для реализации предложенных технических результатов система содержит второй датчик угловой скорости - ω₂, два фильтра оценок угловой скорости - $$\underset{\_}{{\omega }_1}$$ , $$\underset{\_}{{\omega }_2}$$ , два фильтра оценок угла курса $${\underset{\_}{\phi }}_1$$ , $${\underset{\_}{\phi }}_2$$ , блок среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ , блок среднего значения оценки угла курса $$\underset{\_}{{\varphi }_{ср}}$$ , второй датчик угла курса ϕ₂, два датчика поперечной скорости судна Vz₁, Vz₂, два фильтра оценки поперечной скорости судна $$\underset{\_}{V}{z}_1$$ , $$\underset{\_}{V}{z}_2$$ , блок среднего значения оценки поперечной скорости судна $$\underset{\_}{V}{z}_{ср}$$ , датчик оборотов подруливающего устройства n, регулятор и привод подруливающего устройства.

Функции, выполняемые модулями системы, и связи между ними:

- датчик угловой скорости - ω₁ подключен к первому входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1,}$$

- датчик угловой скорости - ω₂ подключен к первому входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2,}$$

- датчик руля - δ подключен ко второму входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ и ко второму входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ соответственно,

- датчик скорости хода - V_x подключен к третьему входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ и к третьему входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ соответственно,

- выход фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ подключен к четвертому входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1,}$$

- выход фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ подключен к четвертому входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ .

В фильтре оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ формируется $$\underset{\_}{:}$$

- оценка угловой скорости - $$\underset{\_}{{\omega }_1\left(1\right)}$$ :

$$d/dt\underset{\_}{{\omega }_1}=m_{1\underset{\_}{\omega 1}}{V}_x\underset{\_}{{\omega }_1}+m_{1{\underset{\_}{Vz1}}_{-}}{V}_x\underset{\_}{V}{z}_1-m_{1\delta }{V}_x{V}_x\delta +K_1\left({\omega }_1-\underset{\_}{{\omega }_1}\right)\left(1\right)$$

где V_x - скорость хода судна (с датчика скорости хода судна - V_x),

$$\underset{\_}{V}{z}_1$$ - оценка поперечной скорости (с фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ ),

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

m_1i - гидродинамические коэффициенты математической модели движения судна,

K₁ - коэффициент Калмановской фильтрации;

- условие исправной работы канала оценки угловой скорости - $$\underset{\_}{{\omega }_1\left(2\right)}$$ :

$$\left|{\omega }_1-\underset{\_}{{\omega }_1}\right|\le C_1=cons\tan t\left(2\right)$$

где ω₁ - угловая скорость судна (с датчика угловой скорости ω₁).

При удовлетворении условия (2) оценка угловой скорости - $$\underset{\_}{{\omega }_1,}$$ с фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1,}$$ подключается на первый вход блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ .

В фильтре оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ формируется:

- оценка угловой скорости - $$\underset{\_}{{\omega }_2}$$ (1а)

$$d/dt\underset{\_}{{\omega }_2}=m_{1\underset{\_}{\omega 2}}{V}_x\underset{\_}{{\omega }_2}+m_{1{\underset{\_}{Vz2}}_{-}}{V}_x\underset{\_}{V}{z}_2-m_{1\delta }{V}_x{V}_x\delta +K_1\left({\omega }_2-\underset{\_}{{\omega }_2}\right)\left(1a\right)$$

где V_x - скорость хода судна (с датчика скорости хода судна - V_x),

$$\underset{\_}{V}{z}_2$$ - оценка поперечной скорости (с выхода фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ ),

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

m_1i - гидродинамические коэффициенты математической модели движения судна,

K₁ - коэффициент Калмановской фильтрации;

- условие исправной работы канала оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ (2а):

$$\left|{\omega }_2-\underset{\_}{{\omega }_2}\right|\le C_1=cons\tan t\left(2a\right)$$

где ω₂ - угловая скорость судна (с датчика угловой скорости ω₂).

При удовлетворении условия (2a) оценка угловой скорости - $$\underset{\_}{{\omega }_2}$$ с фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ подключается на второй вход блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ .

В блоке среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ формируется - $$\underset{\_}{{\omega }_{ср}}$$ :

- при наличии двух оценок $$\underset{\_}{{\omega }_1}$$ и $$\underset{\_}{{\omega }_2}$$ :

$$\underset{\_}{{\omega }_{ср}}=\left(\underset{\_}{{\omega }_1}+\underset{\_}{{\omega }_2}\right)/2$$

или

- при наличии только одной оценки $$\underset{\_}{{\omega }_1}$$ или $$\underset{\_}{{\omega }_2}$$ :

$$\underset{\_}{{\omega }_{ср}}$$ = $$\underset{\_}{{\omega }_1}$$ $$или$$ $$\underset{\_}{{\omega }_{ср}}$$ = $$\underset{\_}{{\omega }_2}$$ .

Выход блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ подключен к третьему входу сумматора,

- датчик угла курса - ϕ₁ подключен к первому входу фильтра оценки угла курса - $${\varphi }_{\underset{\_}{1}},$$

- датчик угла курса - ϕ₂ подключен к первому входу фильтра оценки угла курса - $${\varphi }_{\underset{\_}{2}},$$

- выход блока среднего значения оценки угла курса - $$\underset{\_}{{\omega }_{ср}}$$ подключен, соответственно, ко вторым входам двух фильтров оценки угла курса $${\underset{\_}{\phi }}_1$$ и $${\underset{\_}{\phi }}_2$$ .

В фильтре оценки угла курса - $${\underset{\_}{\phi }}_1$$ формируется:

- сигнал оценки угла курса $$\underset{\_}{{\phi }_1}\left(3\right)$$ :

$$d/dt\underset{\_}{{\phi }_1}=\underset{\_}{{\omega }_{ср}}+K_2\left({\phi }_1-\underset{\_}{{\phi }_1}\right)\left(3\right)$$

где $$\underset{\_}{{\omega }_{ср}}$$ - среднее значение оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ (с выхода блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ ),

ϕ₁ - угол курса (с датчика угла курса - ϕ₁),

К₂ - коэффициент Калмановской фильтрации,

- условие исправной работы канала оценки угла курса - $${\phi }_1\left(4\right)$$ :

$$\left|{\phi }_1-\underset{\_}{{\phi }_1}\right|\le C_1=cons\tan t\left(4\right)$$

где ϕ₁ - угол курса (с датчика угла курса - ϕ₁).

При удовлетворении условия (4) оценка угла курса - $$\underset{\_}{{\phi }_1}$$ с фильтра оценки угла курса - $$\underset{\_}{{\phi }_1}$$ подключается к первому входу блока среднего значения оценки угла курса - $$\underset{\_}{{\varphi }_{ср}}$$ .

Выход блока среднего значения оценки угла курса - $$\underset{\_}{{\varphi }_{ср}}$$ подключается через четвертый вход к сумматору.

В сумматоре формируется закон управления рулевым приводом (5):

$$d/dt\delta =K_1\left(\underset{\_}{{\varphi }_{ср}}-\underset{\_}{{\varphi }_{зд}}\right)+K_2\underset{\_}{{\omega }_{ср}}-K_3\delta \left(5\right)$$

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

$$\underset{\_}{{\phi }_{ср}}$$ - среднее значение оценки угла курса,

$$\underset{\_}{{\varphi }_{зд}}$$ - заданный угол курса,

$$\underset{\_}{{\omega }_{ср}}$$ среднее значение оценки угловой скорости судна,

K_i - коэффициенты регулирования.

- Датчик руля - δ подключен ко второму входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ и ко второму входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ соответственно,

- датчик скорости хода - V_x подключен к третьему входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ и к третьему входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ соответственно,

- датчик поперечной скорости судна - Vz₁ подключен к первому входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ ,

- выход фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ подключен к четвертому входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ .

В фильтре оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ формируется:

- оценка поперечной скорости - $$\underset{\_}{V}{z}_1$$ (6):

$$d/dt\underset{\_}{V}{z}_{1\_}=m_{6\underset{\_}{\omega 1}}{V}_x\underset{\_}{{\omega }_1}+m_{6{\underset{\_}{Vz1}}_{-}}{V}_x\underset{\_}{V}{z}_1-m_{6\delta }{V}_x{V}_x\delta +K_3\left(V{z}_1-\underset{\_}{V}{z}_1\right)\left(6\right)$$

где V_x - скорость хода (с датчика скорости хода),

ω₁ - угловая скорость судна (с фильтра оценки угловой скорости $${\underset{\_}{\omega }}_1$$ ),

m_6i - гидродинамические коэффициенты математической модели движения судна,

Vz₁ - поперечная скорость судна (с датчика поперечной скорости - Vz₁),

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

К₃ - коэффициент Калмановской фильтрации;

- условие исправной работы канала оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ (7) $$\underset{\_}{:}$$

$$\left|V{z}_1-\underset{\_}{V}{z}_1\right|\le C_1=cons\tan t\left(7\right)$$

где Vz₁ - поперечная скорость (с датчика поперечной скорости - Vz₁).

При удовлетворении условия (7) оценка поперечной скорости - Vz₁ с фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ подключается на первый вход блока среднего значения оценки поперечной скорости - $$\underset{\_}{V}{z}_{ср}$$ .

В фильтре оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ формируется:

- оценка поперечной скорости - $$\underset{\_}{V}{z}_2$$ (6а):

$$d/dt\underset{\_}{V}{z}_{2\_}=m_{6\underset{\_}{\omega 2}}{V}_x\underset{\_}{{\omega }_2}+m_{6{\underset{\_}{Vz2}}_{-}}{V}_x\underset{\_}{V}{z}_2-m_{6\delta }{V}_x{V}_x\delta +K_3\left(V{z}_2-\underset{\_}{V}{z}_2\right)\left(6a\right)$$

где $$\underset{\_}{{\omega }_2}$$ - оценка угловой скорости судна (с выхода фильтра оценки угловой скорости - $${\underset{\_}{\omega }}_2\underset{\_}{),}$$

V_x - скорость хода судна (с датчика скорости хода - V_x),

m_6i - гидродинамические коэффициенты математической модели движения судна,

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

К₃ - коэффициент Калмановской фильтрации;

- условие исправной работы канала оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ (7а) $$\underset{\_}{:}$$

$$\left|V{z}_2-\underset{\_}{V}{z}_{\underset{\_}{2}}\right|\le C_1=cons\tan t\left(7a\right)$$

где Vz₂ - поперечная скорость (с датчика поперечной скорости - Vz₂).

При удовлетворении условия (7a) оценка поперечной скорости - $$Vz\underset{\_}{{}_2}$$ с фильтра оценки поперечной скорости - $$\underset{\_}{V{z}_2}$$ подключается на второй вход блока среднего значения оценки поперечной скорости - $$\underset{\_}{V}{z}_{ср}$$ .

В блоке среднего значения оценки поперечной скорости - $$\underset{\_}{V}{z}_{ср}$$ , формируется - $$\underset{\_}{V}{z}_{ср}:$$

- при наличии двух оценок $$\underset{\_}{V}{z}_1$$ и $$\underset{\_}{V}{z}_2$$ :

$$\underset{\_}{V}{z}_{ср}=\left(\underset{\_}{V}{z}_{\underset{\_}{1}}+\underset{\_}{V}{z}_{\underset{\_}{2}}\right)/2$$

или

- при наличии только одной оценки $$\underset{\_}{V}{z}_{\underset{\_}{1}}$$ или $$\underset{\_}{V}{z}_{\underset{\_}{2}}$$ :

$$\underset{\_}{V}{z}_{ср}=\underset{\_}{V}{z}_{\underset{\_}{1}}$$ или $$\underset{\_}{V}{z}_{ср}=\underset{\_}{V}{z}_{\underset{\_}{2}}$$ .

Выход блока среднего значения оценки поперечной скорости - Vz_cp подключен к первому входу регулятора, ко второму входу которого подключен датчик оборотов подруливающего устройства - n.

В регуляторе формируется закон управления приводом подруливающего устройства(8):

$$d/dtn=K_4{\underset{\_}{V}}_{zср}+K_5{\displaystyle \int {\underset{\_}{V}}_{zср}dt-K_{\underset{\_}{6}}}n\left(8\right)$$

где n - обороты (винта) подруливающего устройства,

$${\underset{\_}{V}}_{zср}$$ - среднее значение поперечной скорости судна,

$${\displaystyle \int {\underset{\_}{V}}_{zср}dt}$$ - интеграл от среднего значения поперечной скорости судна,

K_i - коэффициенты регулирования.

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

На чертеже приведена блок-схема предлагаемой отказоустойчивой системы управления движением судна со связями между блоками, содержащая:

1) датчик руля - δ; 2) два датчика угловой скорости - ω₁ и ω₂; 3) датчик скорости хода - V_x; 4) два фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ и $$\underset{\_}{{\omega }_2}$$ ; 5) блок среднего значения оценки угловой скорости - $${\underset{\_}{\omega }}_{ср}$$ ; 6) два датчика угла курса ϕ₁ и ϕ₂; 7) два фильтра оценки угла курса ϕ₁ и ϕ₂; 8) блок среднего значения оценки угла курса $${\varphi }_{ср}$$ ; 9) задатчик угла курса ϕ_зд; 10) сумматор; 11) рулевой привод; 12) два датчика поперечной скорости судна Vz₁ и Vz₂; 13) два фильтра оценки поперечной скорости судна V _Z1 и V _Z2; 14) блок среднего значения оценки поперечной скорости судна Vz_cp; 15) датчик оборотов подруливающего устройства n; 16) регулятор; 17) привод подруливающего устройства; 18) объект управления - судно.

Реализацию отказоустойчивой системы управления движением судна целесообразно осуществлять с использованием аппаратно-программных цифровых модулей. В качестве навигационных датчиков может быть использовано две инерциальные - спутниковые навигационные «Мининавигации-1» (разработки ЦНИИ «Электроприбор»). Рулевой привод и подруливающая система - штатные корабельные системы.

Основным каналом автоматического управления движения судна по заданному направлению является управление движением по заданному курсу с использованием штатного рулевого привода - 11, на вход которого подключен сумматор 10. На вход сумматора 10 подключены:

- датчик 1 руля - δ,

- блок 5 среднего значения оценки угловой скорости судна - $$\underset{\_}{{\omega }_{ср}}$$ ,

- блок 8 среднего значения оценки угла курса $${\underset{\_}{\phi }}_{ср}$$ ,

- задатчик 9 угла курса ϕ_зд.

1) Рассмотрим особенности формирования среднего значения оценки угловой скорости судна - $$\underset{\_}{{\omega }_{ср}}$$ и среднего значения оценки угла курса - $${\underset{\_}{\phi }}_{ср}$$ .

Среднее значение оценки угла курса - $${\underset{\_}{\phi }}_{ср}$$ формируется в блоке 8 среднего значения оценки угла курса - $${\underset{\_}{\varphi }}_{ср},$$ на вход которого подключены выходы двух фильтров 7 оценок угла курса $$\underset{\_}{{\phi }_1}$$ и $$\underset{\_}{{\phi }_2}$$ :

- при наличии в блоке 8 среди его значений двух оценок $$\underset{\_}{{\phi }_1}$$ и $$\underset{\_}{{\phi }_2}$$ :

$$\underset{\_}{{\varphi }_{ср}}=\left(\underset{\_}{{\varphi }_1}+\underset{\_}{{\varphi }_2}\right)/2$$

или

- при наличии только одной оценки $$\underset{\_}{{\phi }_1}$$ или $$\underset{\_}{{\phi }_2}$$ :

$$\underset{\_}{{\varphi }_{ср}}=\underset{\_}{{\varphi }_1}$$ или $$\underset{\_}{{\phi }_{ср}}=\underset{\_}{{\phi }_2}$$ .

Выход блока 8 среднего значения оценки угла курса - $$\underset{\_}{\phi }{}_{ср}$$ подключен к четвертому входу сумматора 10.

Среднее значение оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ формируется в блоке 5 среднего значения оценки угла курса - $$\underset{\_}{\phi }{}_{ср}$$ , на вход которого подключены выходы двух фильтров 7 оценок угловой скорости $${\underset{\_}{\omega }}_1$$ и $${\underset{\_}{\omega }}_2$$ :

- при наличии в блоке 5 двух оценок угловой скорости $${\underset{\_}{\omega }}_1$$ и $${\underset{\_}{\omega }}_2$$

$$\underset{\_}{{\omega }_{ср}}=\left({\underset{\_}{\omega }}_1+{\underset{\_}{\omega }}_2\right)/2$$

или

- при наличии только одной оценки $${\underset{\_}{\omega }}_1$$ или $${\underset{\_}{\omega }}_2$$ :

$${\underset{\_}{\omega }}_{ср}=\underset{\_}{{\omega }_1}$$ или $$\underset{\_}{{\omega }_{ср}}=\underset{\_}{{\omega }_2}.$$

Выход блока 5 среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ подключен к третьему входу сумматора 10.

2) Формирование в фильтрах 4 оценки угловой скорости $${\underset{\_}{\omega }}_1$$ и $${\underset{\_}{\omega }}_2$$ .

На вход фильтра 4 оценки угловой скорости $${\underset{\_}{\omega }}_1$$ подключен:

- датчик руля 1 - δ,

- датчик угловой скорости 2 - ω₁,

- датчик 3 скорости хода V_x,

- выход фильтра 13 оценки поперечной силы Vz₁.

Формирование оценки угловой скорости $${\underset{\_}{\omega }}_1$$ (1):

$$d/dt\underset{\_}{{\omega }_1}=m_{1\underset{\_}{\omega 1}}{V}_x\underset{\_}{{\omega }_1}+m_{1{\underset{\_}{Vz1}}_{-}}{V}_x\underset{\_}{V}{z}_1-m_{1\delta }{V}_x{V}_x\delta +K_1\left({\omega }_1-\underset{\_}{{\omega }_1}\right)\left(1\right)$$

где V_x - скорость хода судна (с датчика 3),

$$\underset{\_}{V}{z}_1$$ - оценка поперечной скорости судна (с выхода фильтра 13 оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ ),

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

m_1i - гидродинамические коэффициенты математической модели движения судна,

K₁ - коэффициент Калмановской фильтрации.

2а) Формирование условия нормального функционирования канала оценки угловой скорости $${\underset{\_}{\omega }}_1$$ (2):

$$\left|{\omega }_1-\underset{\_}{{\omega }_1}\right|\le C_1=cons\tan t\left(2\right)$$

где ω₁ - угловая скорость судна (с выхода датчика 2 угловой скорости ω₁).

При удовлетворении условия (2) оценка угловой скорости судна - $$\underset{\_}{{\omega }_1}$$ с выхода фильтра 4 оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ вводится на первый вход блока 5 среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ .

2б) В фильтре 4 оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ , аналогично описанному для $$\underset{\_}{{\omega }_1,}$$ формируется:

- оценка угловой скорости $$\underset{\_}{{\omega }_2}$$ в соответствии с зависимостью (1а):

$$d/dt\underset{\_}{{\omega }_2}=m_{1\underset{\_}{\omega 2}}{V}_x\underset{\_}{{\omega }_2}+m_{1{\underset{\_}{Vz2}}_{-}}{V}_x\underset{\_}{V}{z}_2-m_{1\delta }{V}_x{V}_x\delta +K_1\left({\omega }_2-\underset{\_}{{\omega }_2}\right)\left(1a\right)$$

где V_x - скорость хода судна (вводится с датчика 3 скорости хода - V_x),

$$\underset{\_}{V}{z}_2$$ - оценка поперечной скорости судна (поступает с фильтра 12 оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ ),

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

m_1i - гидродинамические коэффициенты математической модели движения судна,

K₁ - коэффициент Калмановской фильтрации;

- условие нормального функционирования канала оценки угловой скорости $${\underset{\_}{\omega }}_2$$ (2а):

$$\left|{\omega }_2-\underset{\_}{{\omega }_2}\right|\le C_1=cons\tan t\left(2a\right)$$

где ω₂ - угловая скорость судна (с датчика 2 угловой скорости ω₂).

2в) При удовлетворении условия (2а) оценка угловой скорости судна - $$\underset{\_}{{\omega }_2}$$ с выхода фильтра 4 оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ вводится на второй вход блока 5 среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ .

3) Формирование оценок угла курса $$\underset{\_}{{\phi }_1}$$ и $$\underset{\_}{{\phi }_2}$$ .

На вход фильтра 7 оценки угла курса $$\underset{\_}{{\phi }_1}$$ подключен:

- датчик 6 угла курса - ϕ₁,

- выход блока 5 среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ .

3а) Используя эту информацию в фильтре 7 вычисляется:

- оценка угла курса $$\underset{\_}{{\phi }_1}$$ (3):

$$d/dt\underset{\_}{{\phi }_1}=\underset{\_}{{\omega }_{ср}}+K_2\left({\phi }_1-\underset{\_}{{\phi }_1}\right)\left(3\right)$$

где $$\underset{\_}{{\omega }_{ср}}$$ - среднее значение оценки угловой скорости - $$\underset{\_}{{\omega }_{ср},}$$

ϕ₁ - угол курса,

K₂ - коэффициент Калмановской фильтрации;

- условие нормального функционирования канала оценки угла курса $$\underset{\_}{{\phi }_1}$$ (4):

$$\left|{\phi }_1-\underset{\_}{{\phi }_1}\right|\le C_1=const,\left(4\right)$$

где ϕ₁ - угол курса (с датчика угла курса ϕ₁).

3б) При удовлетворении условия (4) оценка угла курса $$\underset{\_}{{\phi }_1}$$ с выхода фильтра 7 оценки угла курса $$\underset{\_}{{\phi }_1}$$ вводится на первый вход блока 8 среднего значения оценки угла курса $$\underset{\_}{{\omega }_{ср}.}$$

3в) В фильтре 7 оценки угла курса - $$\underset{\_}{{\varphi }_2},$$ аналогично описанному для оценки $$\underset{\_}{{\phi }_1,}$$ формируется:

- оценка угла курса $$\underset{\_}{{\phi }_2}$$ с использованием датчика 6 угла курса - ϕ₂ (3а):

$$d/dt\underset{\_}{{\phi }_2}=\underset{\_}{{\omega }_{ср}}+K_2\left({\phi }_2-\underset{\_}{{\phi }_2}\right)\left(3a\right)$$

где $$\underset{\_}{{\omega }_{ср}-}$$ среднее значение оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ (с выхода блока 5),

ϕ₂ - угол курса (с датчика 6. угла курса - ϕ₂),

К₂ - коэффициент Калмановской фильтрации;

- условие нормального функционирования канала оценки угла курса $$\underset{\_}{{\phi }_2}$$ (4а):

$$\left|{\phi }_2-\underset{\_}{{\phi }_2}\right|\le C_2=const,\left(4a\right)$$

где ϕ₂ - угол курса (с датчика 6. угла курса ϕ₂).

3г) При удовлетворении условия (4a) оценка угла курса $$\underset{\_}{{\phi }_2}$$ с выхода фильтра 7 оценки угла курса $$\underset{\_}{{\phi }_2}$$ вводится на второй вход блока 8 среднего значения оценки угла курса $$\underset{\_}{{\phi }_{ср}.}$$

Выход блока среднего значения оценки угла курса - $$\underset{\_}{\phi {}_{ср}}$$ подключается через четвертый вход к сумматору.

В сумматоре 10 формируется закон управления рулевым приводом (5):

$$d/dt\delta =K_1\left(\underset{\_}{{\varphi }_{ср}}-\underset{\_}{{\varphi }_{зд}}\right)+K_2\underset{\_}{{\omega }_{ср}}-K_3\delta \left(5\right)$$

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

$$\underset{\_}{{\phi }_{ср}}$$ - среднее значение оценки угла курса,

$$\underset{\_}{{\varphi }_{зд}}$$ - заданный угол курса,

$$\underset{\_}{{\omega }_{ср}}$$ - среднее значение оценки угловой скорости судна,

K_i - коэффициенты регулирования.

4) Рассмотрим формирование среднего значения оценок поперечной скорости $$\underset{\_}{V}{z}_{ср.}$$

На вход фильтра 13 оценки поперечной скорости $$\underset{\_}{V}{z}_1$$ подключены:

- датчик 1 руля - δ,

- датчик 3 скорости хода - V_x,

- фильтр 4 оценки угловой скорости - $${\underset{\_}{\omega }}_1$$ ,

- датчик 12 поперечной скорости - Vz₁,

для формирования:

- оценки поперечной скорости $$\underset{\_}{V}{z}_1$$ (6):

$$d/dt\underset{\_}{V}{z}_{1\_}=m_{2\underset{\_}{\omega 1}}{V}_x\underset{\_}{{\omega }_1}+m_{2{\underset{\_}{Vz1}}_{-}}{V}_x\underset{\_}{V}{z}_1-m_{2\delta }{V}_x{V}_x\delta +K_3\left(V{z}_1-\underset{\_}{V}{z}_1\right)\left(6\right)$$

- условия нормального функционирования канала оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ (7):

$$\left|V{z}_1-\underset{\_}{V}{z}_1\right|\le C_1=const,\left(7\right)$$

где Vz₁ - поперечная скорость судна (с выхода датчика 12 поперечной скорости Vz₁).

При удовлетворении условия (7) оценка поперечной скорости - $$\underset{\_}{V}{z}_1$$ с выхода фильтра 13 оценка поперечной скорости $$\underset{\_}{V}{z}_1$$ вводится на первый вход блока 14 среднего значения оценки поперечной скорости - $$\underset{\_}{V{z}_{ср}}$$ .

Формирование оценки поперечной скорости $$\underset{\_}{V}{z}_2$$ осуществляется в фильтре 12 оценки поперечной скорости $$\underset{\_}{V}{z}_2$$ , аналогично оценке $$\underset{\_}{V}{z}_1,$$ в соответствии с зависимостью (6а):

$$d/dt\underset{\_}{V}{z}_{2\_}=m_{2\underset{\_}{\omega 2}}{V}_x\underset{\_}{{\omega }_{12}}+m_{2{\underset{\_}{Vz2}}_{-}}{V}_x\underset{\_}{V}{z}_2-m_{2\delta }{V}_x{V}_x\delta +K_3\left(V{z}_2-\underset{\_}{V}{z}_2\right)\left(6a\right)$$

Условие нормального функционирования канала оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ формируется в соответствии с зависимостью (7а):

$$\left|V{z}_2-\underset{\_}{V}{z}_{\underset{\_}{2}}\right|\le C_3=const,\left(7a\right)$$

При удовлетворении условия (7а) оценка поперечной скорости - $${\underset{\_}{Vz}}_2$$ с выхода фильтра 13 оценки поперечной скорости $${\underset{\_}{Vz}}_2$$ вводится на второй вход блока 14 среднего значения оценки поперечной скорости - $$\underset{\_}{V{z}_{ср}}$$ .

В блоке 14 среднего значения оценка поперечной скорости - $$\underset{\_}{V{z}_{ср}}$$ формируется $$\underset{\_}{V{z}_{ср}:}$$

- при наличии двух оценок $$\underset{\_}{V}{z}_1$$ и $$\underset{\_}{V}{z}_{2=1}.$$

$${\underset{\_}{Vz}}_{ср}=\left(\underset{\_}{V}{z}_1+\underset{\_}{V}{z}_2\right)/2$$ ,

- при наличии только одной оценки $$\underset{\_}{V}{z}_1$$ или $$\underset{\_}{V}{z}_2$$

$${\underset{\_}{Vz}}_{ср}=\underset{\_}{V}{z}_1$$ или $${\underset{\_}{Vz}}_{ср}=\underset{\_}{V}{z}_2$$ .

- Блок 14 среднего значения оценки поперечной скорости - $$\underset{\_}{V}{z}_{ср}$$ подключен к первому входу регулятора 16.

- Ко второму входу регулятора 16 подключен датчик 15 оборотов винта подруливающего устройства - n.

- На выходе регулятора 16 формируется закон управления приводом подруливающего устройства 17:

$$d/dtn=K_4{\underset{\_}{V}}_{zср}+K_5{\displaystyle \int {\underset{\_}{V}}_{zср}dt-K_{\underset{\_}{6}}}n\left(8\right)$$

где n - обороты винта подруливающего устройства,

$${\underset{\_}{V}}_{zср}$$ - среднее значение поперечной скорости судна,

$${\displaystyle \int {\underset{\_}{V}}_{zср}dt}$$ - интеграл от среднего значения поперечной скорости судна по времени,

K_i - коэффициенты регулирования.

Таким образом, при использовании закона (8) подруливающее устройство осуществляет автоматическое поддержание нулевого угла дрейфа (поперечной скорости судна V_z=0). Стабилизация нулевой поперечной скорости вблизи нуля существенно повышает эффективность и точность работы САУД при движении по заданному направлению.

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

Отказоустойчивая система управления движением судна, содержащая датчик руля δ, датчик угловой скорости ω₁, датчик скорости хода V_x, датчик угла курса $${\varphi }_1$$ , задатчик угла курса $${\varphi }_{зд},$$ сумматор, рулевой привод, датчик руля δ, подключенный к первому входу сумматора, ко второму входу которого подключен задатчик угла курса $${\varphi }_{зд},$$ выход сумматора подключен к входу рулевого привода, отличающаяся тем, что содержит дополнительно датчик угла курса $${\varphi }_2,$$ два фильтра оценки угла курса $${\underset{\_}{\varphi }}_1$$ и $${\underset{\_}{\varphi }}_2,$$ два фильтра оценок угловой скорости $$\underset{\_}{{\omega }_1}$$ и $$\underset{\_}{{\omega }_2},$$ блок среднего значения оценки угловой скорости $$\underset{\_}{{\omega }_{ср}}$$ , блок среднего значения оценки угла курса $${\underset{\_}{\varphi }}_{ср}$$ _, два датчика поперечной скорости судна Vz₁ и Vz₂, два фильтра оценки поперечной скорости судна $$\underset{\_}{V}{z}_1$$ и $$\underset{\_}{V}{z}_2$$ , блок среднего значения оценки поперечной скорости судна Vz_ср, датчик оборотов подруливающего устройства n, регулятор, привод подруливающего устройства и датчик угловой скорости ω₂, которые соединены:
- датчик угловой скорости - ω₂ подключен к первому входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2},$$
- датчик угловой скорости - ω₁ подключен к первому входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1},$$
- датчик руля - δ подключен ко второму входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ и ко второму входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ соответственно,
- датчик скорости хода - V_x подключен к третьему входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ и к третьему входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ соответственно,
- выход фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ подключен к четвертому входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ ,
- выход фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ подключен к четвертому входу фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ , при этом
в фильтре оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ формируется:
- оценка угловой скорости - $$\underset{\_}{{\omega }_1}$$ (1):
$$d/dt\underset{\_}{{\omega }_1}=m_{1\underset{\_}{\omega 1}}{V}_x\underset{\_}{{\omega }_1}+m_{1{\underset{\_}{Vz1}}_{-}}{V}_x\underset{\_}{V}{z}_1-m_{1\delta }{V}_x{V}_x\delta +K_1\left({\omega }_1-\underset{\_}{{\omega }_1}\right)\left(1\right)$$
где V_x - скорость хода судна (с датчика скорости хода судна - V_x),
$$\underset{\_}{V}{z}_1$$ - оценка поперечной скорости (с фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ ),
ω₁ - угловая скорость судна (с датчика угловой скорости - ω₁),
m_1i - гидродинамические коэффициенты математической модели движения судна,
K₁ - коэффициент Калмановской фильтрации,
- условие исправной работы канала оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ :
$$\left|{\omega }_1-\underset{\_}{{\omega }_1}\right|\le C_1=cons\tan t\left(2\right)$$
где ω₁ - угловая скорость судна (с датчика угловой скорости ω₁),
при удовлетворении условия (2) оценка угловой скорости - $$\underset{\_}{{\omega }_1}$$ с фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ подключается на первый вход блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ ,
в фильтре оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ формируется:
- оценка угловой скорости - $$\underset{\_}{{\omega }_2}$$ (1a):
$$d/dt\underset{\_}{{\omega }_2}=m_{1\underset{\_}{\omega 2}}{V}_x\underset{\_}{{\omega }_2}+m_{1{\underset{\_}{Vz2}}_{-}}{V}_x\underset{\_}{V}{z}_2-m_{1\delta }{V}_x{V}_x\delta +K_1\left({\omega }_2-\underset{\_}{{\omega }_2}\right)\left(1a\right)$$
где V_x - скорость хода судна (с датчика скорости хода судна - V_x),
$$\underset{\_}{V}{z}_2$$ - оценка поперечной скорости (с выхода фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ ),
ω₂ - угловая скорость судна (с датчика угловой скорости ω₂),
m_1i - гидродинамические коэффициенты математической модели движения судна,
K₁ - коэффициент Калмановской фильтрации,
- условие исправной работы канала оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ (2а):
$$\left|{\omega }_2-\underset{\_}{{\omega }_2}\right|\le C_1=cons\tan t\left(2a\right)$$
где ω₂ - угловая скорость судна (с датчика угловой скорости ω₂),
при удовлетворении условия (2a) оценка угловой скорости - $$\underset{\_}{{\omega }_2}$$ с фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ подключается на второй вход блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ ,
в блоке среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ формируется - $$\underset{\_}{{\omega }_{ср}}$$ :
а) при наличии двух оценок $$\underset{\_}{{\omega }_1}$$ и $$\underset{\_}{{\omega }_2}$$ :
$$\underset{\_}{{\omega }_{ср}}$$ =( $$\underset{\_}{{\omega }_1}$$ + $$\underset{\_}{{\omega }_2}$$ )/2,
или
б) при наличии только одной оценки $$\underset{\_}{{\omega }_1}$$ :
$$\underset{\_}{{\omega }_{ср}}$$ = $$\underset{\_}{{\omega }_1}$$ ,
или
в) при наличии только одной оценки $$\underset{\_}{{\omega }_2}$$ :
$$\underset{\_}{{\omega }_{ср}}$$ = $$\underset{\_}{{\omega }_2}$$ ,
выход блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ подключен к третьему входу сумматора,
- датчик угла курса - $${\varphi }_1$$ подключен к первому входу фильтра оценки угла курса - $${\varphi }_{\underset{\_}{1}},$$
- датчик угла курса - $${\varphi }_2$$ подключен к первому входу фильтра оценки угла курса - $${\varphi }_{\underset{\_}{2}},$$
- выход блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ подключен ко вторым входам двух фильтров оценки угла курса $${\underset{\_}{\varphi }}_1$$ и $${\underset{\_}{\varphi }}_2,$$
в фильтре оценки угла курса - $${\underset{\_}{\varphi }}_1$$ формируется:
- сигнал оценки угла курса $$\underset{\_}{{\varphi }_1}$$ (3):
$$d/dt\underset{\_}{{\varphi }_1}=\underset{\_}{{\omega }_{ср}}+K_2\left({\varphi }_1-\underset{\_}{{\varphi }_1}\right)\left(3\right)$$
где $$\underset{\_}{{\omega }_{ср}}$$ - среднее значение оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ (с выхода блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ ),
ϕ₁ - угол курса (с датчика угла курса - ϕ₁),
К₂ - коэффициент Калмановской фильтрации,
- условие исправной работы, канала оценки угла курса - $${\varphi }_1\left(4\right)$$ :
$$\left|{\varphi }_1-\underset{\_}{{\varphi }_1}\right|\le C_1=cons\tan t\left(4\right)$$
где ϕ₁ - угол курса (с датчика угла курса - ϕ₁),
при удовлетворении условия (4) с фильтра оценки угла курса - $${\underset{\_}{\varphi }}_1$$ оценка угла курса - $${\underset{\_}{\varphi }}_1$$ подключается к первому входу блока среднего значения оценки угла курса - $${\underset{\_}{\varphi }}_{ср}$$ ,
в фильтре оценки угла курса - ϕ₂ формируется:
- сигнал оценки угла курса $${\underset{\_}{\varphi }}_2$$ (3а):
$$d/dt\underset{\_}{{\varphi }_2}=\underset{\_}{{\omega }_{ср}}+K_2\left({\varphi }_2-\underset{\_}{{\varphi }_2}\right)\left(3a\right)$$
где $$\underset{\_}{{\omega }_{ср}}$$ - среднее значение оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ (с выхода блока среднего значения оценки угловой скорости - $$\underset{\_}{{\omega }_{ср}}$$ ),
ϕ₂ - угол курса (с датчика угла курса - ϕ₂),
К₂ - коэффициент Калмановской фильтрации,
- условие исправной работы канала оценки угла курса - ϕ₂ (4a):
$$\left|{\varphi }_2-\underset{\_}{{\varphi }_2}\right|\le C_1=cons\tan t\left(4a\right)$$
где ϕ₂ - угол курса (с датчика угла курса - ϕ₂),
при удовлетворении условия (4а) оценка угла курса - $${\underset{\_}{\varphi }}_2$$ с фильтра оценки угла курса - $${\underset{\_}{\varphi }}_2$$ подключается ко второму входу блока среднего значения оценки угла курса - $${\underset{\_}{\varphi }}_{ср}$$ , выход блока среднего значения оценки угла курса - $${\underset{\_}{\varphi }}_{ср}$$ подключается через четвертый вход к сумматору,
в сумматоре формируется закон управления рулевым приводом (5):
$$d/dt\delta =K_1\left(\underset{\_}{{\varphi }_{ср}}-\underset{\_}{{\varphi }_{зд}}\right)+K_2\underset{\_}{{\omega }_{ср}}-K_3\delta \left(5\right)$$
где δ - угол перекладки руля,
$${\underset{\_}{\varphi }}_{ср}$$ - среднее значение оценки угла курса,
$${\underset{\_}{\varphi }}_{зд}$$ - заданный угол курса,
$$\underset{\_}{{\omega }_{ср}}$$ - среднее значение оценки угловой скорости судна,
K_i - коэффициенты регулирования,
датчик руля - δ подключен ко второму входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ и ко второму входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ соответственно,
- датчик скорости хода - V_x подключен к третьему входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ и к третьему входу фильтра оценки поперечной скорости - Vz₂ соответственно,
- датчик поперечной скорости судна - Vz₁ подключен к первому входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ ,
- выход фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_1}$$ подключен к четвертому входу фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ ,
в фильтре оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ формируется:
- оценка поперечной скорости - $$\underset{\_}{V}{z}_1$$ (6):
$$d/dt\underset{\_}{V}{z}_{1\_}=m_{6\underset{\_}{\omega 1}}{V}_x\underset{\_}{{\omega }_1}+m_{6{\underset{\_}{Vz1}}_{-}}{V}_x\underset{\_}{V}{z}_1-m_{6\delta }{V}_x{V}_x\delta +K_3\left(V{z}_1-\underset{\_}{V}{z}_1\right)\left(6\right)$$
где V_x - скорость хода (с датчика скорости хода),
ω₁ - угловая скорость судна (с фильтра оценки угловой скорости $$\underset{\_}{{\omega }_1}$$ ),
m_6i - гидродинамические коэффициенты математической модели движения судна,
Vz₁ - поперечная скорость судна (с датчика поперечной скорости - Vz₁),
δ - угол руля (с датчика угла руля δ),
К₃ - коэффициент Калмановской фильтрации,
- условие исправной работы канала оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ (7):
$$\left|V{z}_1-\underset{\_}{V}{z}_1\right|\le C_1=cons\tan t\left(7\right)$$
где Vz₁ - поперечная скорость (с датчика поперечной скорости - Vz₁),
при удовлетворении условия (7) оценка поперечной скорости - Vz₁ с фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_1$$ подключается на первый вход блока среднего значения оценки поперечной скорости - Vz_ср,
в фильтре оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ формируется:
- оценка поперечной скорости - $$\underset{\_}{V}{z}_2$$ (6а):
$$d/dt\underset{\_}{V}{z}_{2\_}=m_{6\underset{\_}{\omega 2}}{V}_x\underset{\_}{{\omega }_2}+m_{6{\underset{\_}{Vz2}}_{-}}{V}_x\underset{\_}{V}{z}_2-m_{6\delta }{V}_x{V}_x\delta +K_3\left(V{z}_2-\underset{\_}{V}{z}_2\right)\left(6a\right)$$
где $$\underset{\_}{{\omega }_2}$$ - оценка угловой скорости судна (с выхода фильтра оценки угловой скорости - $$\underset{\_}{{\omega }_2}$$ ),
V_x - скорость хода судна (с датчика скорости хода - V_x),
m_6i - гидродинамические коэффициенты математической модели движения судна,
δ - угол руля (с датчика угла руля δ),
К₃ - коэффициент Калмановской фильтрации,
- условие исправной работы канала оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ (7а):
$$\left|V{z}_2-\underset{\_}{V}{z}_{\underset{\_}{2}}\right|\le C_1=cons\tan t\left(7a\right)$$
где Vz₂ - поперечная скорость (с датчика поперечной скорости - Vz₂),
при удовлетворении условия (7a) оценка поперечной скорости - Vz₂ с фильтра оценки поперечной скорости - $$\underset{\_}{V}{z}_2$$ подключается на второй вход блока среднего значения оценки поперечной скорости - $$\underset{\_}{V}{z}_{ср}$$ _,
в блоке среднего значения оценки поперечной скорости - $$\underset{\_}{V}{z}_{ср}$$ формируется - $$\underset{\_}{V}{z}_{ср}:$$
а) при наличии двух оценок $$\underset{\_}{V}{z}_1$$ и $$\underset{\_}{V}{z}_2$$ :
$$\underset{\_}{V}{z}_{ср}$$ = ( $$\underset{\_}{V}{z}_{1\_}$$ + $$\underset{\_}{V}{z}_2$$ )/2,
или
б) при наличии только одной оценки $$\underset{\_}{V}{z}_1$$ (или $$\underset{\_}{V}{z}_{\underset{\_}{2}}$$ ):
$$\underset{\_}{V}{z}_{ср\_}=\underset{\_}{V}{z}_{\underset{\_}{1}}$$ (или $$\underset{\_}{V}{z}_{ср}=\underset{\_}{V}{z}_{\underset{\_}{2}}$$ ),
выход блока среднего значения оценки поперечной скорости - Vz_cp подключен к первому входу регулятора,
- ко второму входу регулятора подключен датчик оборотов подруливающего устройства - n,
- в регуляторе формируется закон управления приводом подруливающего устройства:
$$d/dtn=K_4{\underset{\_}{V}}_{zср}+K_5{\displaystyle \int {\underset{\_}{V}}_{zср}dt-K_{\underset{\_}{6}}}n\left(8\right)$$
где n - обороты (винта) подруливающего устройства,
Vz_ср - среднее значение поперечной скорости судна,
$${\displaystyle \int {\underset{\_}{V}}_{zср}dt}$$ - интеграл от среднего значения поперечной скорости судна,
K_i - коэффициенты регулирования.