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

Формула изобретения

Способ управления движением судна по заданной траектории с использованием блока заданного маршрута, приемника спутниковой навигационной системы, датчика руля, рулевого привода и сумматора, на вход которого подают сигналы: угловой скорости судна и текущего путевого угла - с приемника спутниковой навигационной системы, угла перекладки руля - с датчика руля, заданного путевого угла, последний формируют в блоке заданного маршрута с использованием сигналов широты и долготы точек «Б», «В» (точек поворота заданной траектории движения судна), а также сигналов текущей широты и долготы судна - из приемника спутниковой навигационной системы, отличающийся тем, что в блоке заданного маршрута сформирован набор программных маневров, изменяющих направление движения судна, а также набор координат «упрежденных» точек «Б_{упрежд.}», «В_{упрежд.} », , при достижении которых судно начинает маневр, через интервал времени « t» в блоке заданного маршрута формируют модуль первой разности между сигналом текущей широты судна и сигналом широты точки «Б_{упрежд.}» и модуль второй разности между сигналом текущей долготы судна и сигналом долготы точки «Б_{упрежд.}», если модуль первой разности больше величины «С» или модуль второй разности больше величины «С», то формируют сигнал заданного значения путевого угла по текущим значениям широты и долготы судна и заданным значениям широты и долготы точки «Б_{упрежд.}», который вводят на вход сумматора, сигнал с выхода сумматора подают на вход рулевого привода, в следующие интервалы времени « t» формирование путевого угла повторяют m раз аналогично до момента времени «T₀+m t» когда модуль первой разности между сигналом текущей широты судна и сигналом широты точки «Б_{упрежд.} » и модуль второй разности между сигналом текущей долготы судна и сигналом долготы точки «Б_{упрежд.}» будут меньше «С», то сигнал с выхода сумматора отключают от рулевого привода, на вход которого подключают сигнал программного маневра точки «Б_{упрежд.}» из блока программного маневрирования, в следующий интервал времени « t» в блоке заданного маршрута формируют модуль сигнала разности текущего путевого угла и заданного путевого угла следующей точки поворота «|ПУ-ПУ_зд.ВГ|», если модуль сигнала разности больше допустимого значения, то через интервал времени « t» вновь формируют модуль сигнала разности текущего путевого угла и заданного путевого угла точки поворота «|ПУ-ПУ _зд.ВГ|», в момент времени «T₀+m t+n t», когда модуль сигнала разности текущего путевого угла и заданного путевого угла будет меньше допустимого значения: «|ПУ-ПУ_зд.ВГ|<С», сигнал программного маневра точки «Б_{упрежд.}» из блока программного маневрирования отключают от рулевого привода, а к рулевому приводу подключают выходной сигнал от сумматора, с момента времени «T ₀+m t+(n+1) t» процесс управления движением судна на следующих отрезках траектории от точки «Б» к точке «В» повторяется аналогично рассмотренному выше.

Описание изобретения к патенту

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

Известен способ автоматического управления движением судна по заданному путевому углу, реализованный в «Системе автоматического управления судном» (RU 2248914 С1, 27.03.2005). Способ управления движением судна основан на использовании информации от приемника спутниковой навигационной системы, блока заданного значения путевого угла и сумматора, в котором по сигналам текущего путевого угла, заданного путевого угла, угловой скорости судна формируется сигнал для управления рулевым приводом судна.

Известен также способ автоматического управления движением судна (RU 2292289 С1, 27.03 2007, принятый нами в качестве прототипа), в котором автоматическое управление движением судна осуществляется с использованием сумматора, рулевого привода, блока выработки угловой скорости, датчика руля, приемника спутниковой навигационной системы, блока заданного маршрута с задатчиком точек поворота судна на заданном маршруте. В способе управления движением судна корректируется заданное значения путевого угла в процессе плавания из точки «А» в точку «Б», затем «В» по заданному маршруту. Это гарантирует выход судна в очередную заданную точку изменения направления движения даже при сильном волнении на море.

Известные способы автоматического управления движением по заданной траектории обеспечивают точное движение на отрезках заданной траектории только между точками изменения направления движения. В момент прихода судна в область точки изменения направления движения (пусть точка «Б») вырабатывается команда на изменение заданного путевого угла из блока заданного маршрута, но судно по инерции проскакивает это новое направление движения, выходя на новое направление заданной траектории с большим «перекатом». После выхода на новое заданное направление движения к следующей точке поворота «В» использование известного способа обеспечивает точную стабилизацию судна на заданном путевом угле и приход в точку «Г» следующего изменения направления движения судна.

Однако серьезными недостатками рассмотренных способов управления движением судна по заданной траектории от точек «А» к точке «Б», затем «В» являются:

- использование только закона стабилизации судна, при котором переход с одного направления движения на новое осуществляется с большой затяжкой по времени,

- большая инерционность судна не учитывается (т.к. процесс перехода начинается в точке излома траектории движения), что приводит к значительному уходу судна с заданной траектории в районе заданных точек изменения направления движения «Б», «В»... (переход на новый курс осуществляется с большим перерегулированием).

Рассматриваемый ниже способ лишен этих двух недостатков.

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

- формирование программного управления рулевым приводом (близкого к оптимальному по быстродействию) вблизи точек изменения направления движения судна вместо замкнутого закона управления по путевому углу, которое используется при движении на отрезках траектории от точки «А» к точке «Б» ,

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

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

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

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

- угловой скорости судна и текущего путевого угла - с приемника спутниковой навигационной системы,

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

- заданного путевого угла, последний формируют в блоке заданного маршрута с использованием сигналов широты и долготы точек «Б», «В» (точек поворота заданной траектории движения судна), а также сигналов текущей широты и долготы судна - из приемника спутниковой навигационной системы, при этом в блоке заданного маршрута сформирован набор программных маневров, изменяющих направление движения судна, а также набор координат «упрежденных»точек «Б_{упрежд.}», «В_{упрежд.}», , при достижении которых судно начинает маневр, через интервал времени « t» в блоке заданного маршрута формируют модуль 1 ^ой разности между сигналом текущей широты судна и сигналом широты точки «Б_{упрежд.}» и модуль 2^ой разности между сигналом текущей долготы судна и сигналом долготы точки «Б_{упрежд.}», если модуль 1 ^ой разности больше величины «С» или модуль 2 ^ой разности больше величины «С», то формируют сигнал заданного значения путевого угла по текущим значениям широты и долготы судна и заданным значениям широты и долготы точки «Б_{упрежд.}», который вводят на вход сумматора, сигнал с выхода сумматора подают на вход рулевого привода, в следующие интервалы времени « t» формирование путевого угла повторяют m раз аналогично до момента времени,«Т₀+m t», когда модуль 1^ой разности между сигналом текущей широты судна и сигналом широты точки «Б_{упрежд.} » и 2^ой модуль разности между сигналом текущей долготы судна и сигналом долготы точки «Б_{упрежд.} » будут меньше «С», то сигнал с выхода сумматора отключают от рулевого привода, на вход которого подключают сигнал программного маневра точки «Б_{упрежд.}» из блока программного маневрирования, в следующий интервал времени « t» в блоке заданного маршрута формируют модуль сигнала разности текущего путевого угла и заданного путевого угла следующей точки поворота «|ПУ-ПУ_зд.ВГ|», если модуль сигнала разности больше допустимого значения, то через интервал времени « t» вновь формируют модуль сигнала разности текущего путевого угла и заданного путевого угла точки поворота «|ПУ-ПУ _зд.ВГ|», в момент времени «Т₀+m t+n t», когда модуль сигнала разности текущего путевого угла и заданного путевого угла будет меньше допустимого значения «|ПУ-ПУ_зд.ВГ|< С» сигнал программного маневра точки «Б_{упрежд.}», из блока программного маневрирования, отключают от рулевого привода, а к рулевому приводу подключают выходной сигнал от сумматора, с момента времени «T ₀+m t+(n+l) t». Процесс управления движением судна на следующих отрезках траектории от точки «Б» к точке «В» повторяется аналогично рассмотренному выше.

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

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

- благодаря включению программного управления с заданным упреждением (до прихода судна в точки «Б», «В» , изменения направления движения судна по заданной траектории),

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

Предлагаемый способ управления движением судна по заданной траектории осуществляется с использованием сумматора, рулевого привода, датчика руля, приемника спутниковой навигационной системы (с блоком выработки угловой скорости), блока заданного маршрута (с задатчиком точек поворота траектории из точки «А» в точку «Б», затем «В», по заданному маршруту, и «упреждающих» точек траектории «Б_{упрежд.}», «В_{упрежд.} », ), блока программного маневрирования (с библиотекой-набором законов программного управления) и блока переключения (для переключения закона замкнутого управления на закон программного управления и обратно).

Отличительной особенностью рассматриваемого способа является:

- использование блока программного маневрирования (с набором программ управления рулевым приводом) для осуществления поворота судна (близкого к оптимальному по времени) вблизи заданных точек изменения направления траектории движения «Б», «В» ,

- введением в блок заданного маршрута:

а) координат «упреждающих» точек в заданной траектории (используемых для включения закона программного управления рулевым приводом)

б) формирования условия обратного включения закона стабилизации путевого угла, вместо закона программного управления.

I. Формирование замкнутого закона стабилизации движения судна по заданному путевому углу (режим стабилизации при движении на прямолинейных отрезках траектории между точками «А-Б» затем «Б-В» )

При движении между точками «А-Б» затем «Б-В» используют:

- заданные координаты точек поворота траектории Б( _Б, _Б), затем (В _Б, _Б) (из блока заданного маршрута),

- заданные значения путевого угла «ПУ_ЗД» (из блока заданного маршрута),

- текущие широты, долготы судна ( , ) и путевого угла «ПУ» (от приемника спутниковой навигационной системы (СНС),

- угловой скорости судна « » (с датчика угловой скорости или СНС).

Пусть судно находится в точке «А» (момент времени Т ₀). На выходе сумматора формируется сигнал задания скорости перекладки руля «d/dt _ЗД» (или задания угла перекладки руля ( _ЗД)), который подают на вход рулевого привода:

где ПУ (вводится из приемника СНС), ПУ_зд._»А-Б»(вводится из блока заданного маршрута) - текущий и заданный путевой угол на отрезке «А-Б»,

_ЗД. (вводится из датчика руля) - заданное и текущее значения угла перекладки руля,

- угловая скорость судна (вводится из приемника СНС),

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

Это приводит к движению судна от точки «А» (момент времени «Т₀») к точке «Б» по заданному путевому углу «ПУ_{зд. А-Б}». Через интервал времени « t» в момент времени «T₀+ t» корректируют сигнал заданного путевого угла «ПУ _{ЗД.«А-Б»}». Для этой цели в блоке заданного маршрута формируют модуль 1^ой разности между сигналом текущей широты судна и сигналом широты «упрежденной» точки - начала изменения направления движения судна «Б _{упрежд.}» (близкой к точке «Б») и модуль 2 разности между сигналом текущей долготы судна и сигналом долготы «упрежденной» точки «Б_{упрежд.}».

Рассмотрим управление при выполнении условия (2) или (3)

где ( - _{(Бупрежд.)}), ( - _{(Бупрежд.)}) - разности текущей широты (долготы) судна и широты (долготы) «упрежденной» точки «Бупрювд» (которая расположена на траектории движения ближе к точке «А» на величину « » по сравнению с точкой «Б»).

Если удовлетворяется зависимость (2) модуль 1^ой разности больше величины «С» или модуль 2^ой разности больше величины «С», то формируют сигнал корректированного заданного значения путевого угла (ПУ_зд.(_А-Б )_{.кор 1..}) по текущим значениям широты и долготы судна в момент времени «T₁=T₀+ t» и заданным значениям широты и долготы «упрежденной» точки «Б_{упрежд.}» (начала поворота судна вблизи точки «Б», приближенной на величину « » к точке «А»). Сигнал корректированного заданного путевого угла вводят на вход сумматора вместо «ПУ _{зд.«А-Б»}». Сигнал с выхода сумматора подают на вход рулевого привода. Рулевой привод корректирует движение судна, устраняя возникшее отклонение движения судна с заданной траектории. Процесс выработки корректированного значения заданного путевого угла многократно повторяется через интервалы времени « t».

II. Формирование закона программного управления в блоке программного маневрирования (когда судно находится вблизи точек изменения направления движения выполняется условие (3)).

В блоке программного маневрирования сформирован:

- набор программных маневров для всех точек поворота траектории движения: «Б», «В», с использованием динамической модели движения конкретного судна и конкретных величин приращений заданного путевого угла в точках «Б», «В» : ПУ_ЗД.Б=(ПУ_ЗД.БВ - ПУ_зд.АБ ), ПУ_зд.В=(ПУ_зд.ВГ - ПУ_зд.БВ ) , (маневры переходов ПУ_зд.i, формировались путем моделирования и выбирались наиболее близкими к оптимальным по времени),

- набор «упрежденных» точек траектории «Б_{упрежд.}», «В _{упрежд.}» (при достижении которых судном начинается процесс изменения путевого угла); координаты «упрежденных точек «Б_{упрежд.}» формировались с использованием конкретных программных маневров и заданных для них приращений путевого угла « ПУ_зд.i» путем вложения процесса перехода динамической модели корабля в новое направление движения с допустимым перегулированием по путевому углу.

Через «m» интервалов времени, когда будет выполняться зависимость (3) (в момент времени: T₀+m t=Т_Б- ₁=Т_{Бупрежд.} - нахождении судна в первой «упрежденной» точке начала поворота «Б _{упрежд.}»), в блоке программного маневрирования выбирают из набора программных маневров для всех точек поворота траектории движения:«Б» «В».'. программный маневр d/dt _{зд.Бупрежд.}

Сигнал по зависимости (4) из блока программного маневрирования с момента времени «Т_{Бупрежд.} » вводят на вход рулевого привода, вместо сигнала d/dt _зд по зависимости (li) с выхода сумматора. Судно начинает переход на новое заданное направление движения к ПУ _ЗД.Б-В.

3. Переход на режим замкнутого закона управления

Формируем условие перехода на режим стабилизации в блоке заданного маршрута. Это условие должно выполняться, когда текущее значение путевого угла будет находиться в допустимой области ПУ_ЗД.Б-В:

При выполнении условия (5) сигнал d/dt _{зд Бупрежд.}=f (t), поступающий из блока программного маневрирования, отключается от рулевого привода, а к рулевому приводу подключается сигнал по зависимости (li): d/dt _зд=f (ПУ-ПУ_зд._Б-В), поступающий с выхода сумматора. Так обеспечивается вновь замкнутое управление (стабилизация судна по путевому углу ПУ_{ЗД.<<Б-В>>} ):

Управление судном по ПУ_{зд.«Б-В»} продолжается до прихода судна в точку «В_{упрежд.} » (начала второго поворота судна (вблизи второй точки «В»). При выполнении условия (3а), которое формируется в блоке заданного маршрута

из блока заданного маршрута поступают сигналы:

- на отключение сигнала закона (li) от рулевого привода (поступающего с выхода сумматора),

- на подключение сигнала закона программного управления на вход рулевого привода (с выхода блока программного маневрирования)

Судно начинает переход на новое заданное направление движения в область ПУ_зд.В-Г.

В блоке заданного маршрута формируется сигнал: (ПУ- ПУ_зд.В-Г ), когда модуль разности этого сигнала станет меньше заданного значения, то сформируется сигнал, отключающий рулевой привод от блока программного маневрирования и подключающий вход рулевого привода к выходу сумматора. Вновь включится закон стабилизации судна по путевому углу ПУ_зд.В-Г аналогично выше рассмотренному.

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

Рассмотрим работу конкретного устройства автоматического управления движением судна по заданной траектории из точки «А» (с момента времени Т₀) в точку «Б», реализованного в соответствии с предлагаемым способом автоматического управления движением корабля.

Устройство содержит сумматор - 1., рулевой привод - 2., блок выработки угловой скорости - 3., датчик руля - 4., приемник спутниковой навигационной системы (СНС) - 5., блок заданного маршрута - 6., блок программного маневрирования - 7., блок переключения - 8., судно - объект управления - 9.

Все связи между блоками устройства приведены на чертеже. Реализация предлагаемого устройства может быть осуществлена с использованием микросхем типа 140 УД 6 (сумматор-1., блок программного маневрирования - 7., блок заданного маршрута-6.). Блок выработки угловой скорости - 3., типовой датчик угловой скорости (ДУС-5 с чувствительностью не ниже 0,05 гр/с). Штатные корабельные системы: приемник СНС - 5., рулевой привод - 2.

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

На вход сумматора 1. поступают сигналы угловой скорости судна « » с блока выработки угловой скорости 3, угла перекладки руля « » - с датчика руля 4, текущего путевого угла «ПУ» с приемника спутниковой навигационной системы 5. и заданного путевого угла ПУ_зд. с блока заданного маршрута 6. На выходе сумматора 1. формируется заданное значение угловой скорости перекладки руля «d/dt _зд.». В соответствии с зависимостью (1) руль будет автоматически перекладываться и обеспечивать удержание судна на заданной траектории движения с путевым углом, равным заданному: ПУ=ПУ_зд.А-Б.

В блоке задания маршрута 6. осуществляется циклически через интервалы времени « t» вычисление величины заданного значения путевого угла ПУ_зд. (см. описание формирования корректированного (ПУ_{зд.(А-Б).кор.1} выше). Корректированное значение ПУ_{зд.(А-Б).кор.1} поступает на вход сумматора 1. и далее в рулевой привод 2. на перекладку руля, обеспечивая выход судна на заданное уточненное направление движения. Сигналы циклов перестройки значений ПУ _зд осуществляются в блоке 6. через интервал времени « t»

В момент времени Т₀. (из приемника спутниковой навигационной системы 5.) текущие широта и долгота местонахождения судна ( , ) поступают в блок 6., в котором также содержатся широты и долготы всех i-«упрежденных» точек поворота судна (в рассматриваемом случае первая точка изменения направления движения - «Б_упреж»). По сигналам текущего местонахождения судна ( , ) и точке начала поворота Б_{упрежд.}( _i=Б_{упрежд., i}=Б_{упрежд.}) формируются зависимости вида (2) и (3). Если выполняется зависимость (2), в блоке 6. формируется заданное значение путевого угла по текущему местонахождению судна ( , ) и точке Б_{упрежд.} ( _i= Б_{упрежд.} , _i=Б_{упрежд.}).

Если выполняется зависимость (3) (что соответствует нахождению судна в точке «Б_{упрежд.}» в момент времени Т _{Бупрежден.}=Т₀+m t - первого поворота судна) из блока заданного маршрута - 6 поступает сигнал на формирование в блоке программного маневрирования - 7 программы маневрирования d/dt _{зд.Бупрежд.} (из суммарного набора программ маневрирования в блоке - 7). Сигнал из блока заданного маршрута - 6 также поступает в блок переключения - 8 на подключение блока программного маневрирования - 7 к входу рулевого привода - 2 и отключению от рулевого привода - 2 выхода сумматора - 1. Это приведет к началу маневра судна с путевого угла «ПУ_{зд.«АБ»}» в область ПУ_зд.Б-В. Через каждый интервал времени t в блоке заданного маршрута - 6 формируется сигнал по зависимости (5). В момент времени, когда условие (5) удовлетворится, из блока заданного маршрута - 6 поступит сигнал в блок переключения - 8 на отключение выхода блока - 7 и подключения сигнала с блока - 1 к рулевому приводу, что приведет к переходу на режим стабилизации судна на отрезке траектории «Б-В» с путевым углом ПУ _{зд.«Б-В»}.

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