устройство для формирования траектории перевода судна на новый курс

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

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

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

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

Наиболее близким к изобретению является устройство для автоматического вывода судна на заданную прямолинейную траекторию прохождения узкого участка фарватера и удержания его на этой траектории, которое содержит автоматический регулятор путевого угла, датчики координат центра масс судна, путевого угла, угловой скорости поворота судна в горизонтальной плоскости, продольной скорости судна, угла перекладки руля, выходы которых соединены соответственно с первым, вторым, третьим, четвертым и пятым входами автоматического регулятора путевого угла, снабженного вычислителем заданных параметров и бокового отклонения с тремя входами, первый вход которого образует одноименный вход автоматического регулятора путевого угла автоматического регулятора путевого угла, и вычислителем сигнала управления с шестью входами, второй, третий, четвертый и пятый входы которого образуют одноименные входы автоматического регулятора путевого угла, первый вход которого образован выходом вычислителя заданных параметров движения и бокового отклонения, а выход упомянутого автоматического регулятора, образованный выходом вычислителя сигнала управления, подключен к рулевому приводу, механически связанному с рулем, который механически соединен с датчиком угла перекладки руля и корпусом судна, с которым механически связаны датчики координат центра масс судна, путевого угла, угловой скорости поворота судна в горизонтальной плоскости, продольной скорости судна, блок расчета теоретической траектории перехода из начальной точки на заданную прямолинейную траекторию прохождения узкого участка фарватера с шестью входами и тремя выходами и блок постоянной памяти с тремя выходами, в который записаны параметры заданной траектории прохождения узкого участка фарватера, минимальный радиус кривизны траектории движения судна, коэффициенты закона управления, первый выход которого соединен с шестым входом упомянутого автоматического регулятора, а второй и третий выходы блока постоянной памяти подключены к пятому и шестому входам упомянутого блока расчета теоретической траектории, первый, второй, третий и четвертый входы которого соединены соответственно с выходами датчиков координат центра масс судна, путевого угла, угловой скорости порота судна в горизонтальной плоскости и продольной скорости, первый и второй выходы упомянутого блока расчета теоретической траектории подключены соответственно к седьмому и восьмому входом автоматического регулятора путевого угла, а третий выход упомянутого блока расчета теоретической траектории служит для формирования сигнала судоводителю (патент RU 2406645 C1, G01C 21/14, опубликован 14.08.2009).

Недостатком устройства для автоматического вывода судна на заданную прямолинейную траекторию является отсутствие учета ограничений на величину сигнала управления при формировании теоретической траектории перевода судна из начальной точки на заданную прямолинейную траекторию. В патенте RU 2406645 C1, G01C 21/14 теоретическая траектория используется как исполнительная. На достаточно высокой скорости движения судна превышение сигналом управления допустимой величины может привести к возникновению аварийной ситуации, а неполная отработка расчетной величины сигнала управления приводит к повышению отклонения судна от исполнительной траектории движения.

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

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

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

На фиг.2 - основные параметры траектории перехода судна на новый курс.

На фиг.3 - элементарный полиномиальный отрезок r₀Ar₁, обеспечивающий изменение курса на угол , где R_sc - радиус задающей окружности отрезка r₀Ar₁, R_m - минимальный радиус кривизны отрезка r₀Ar₁.

На фиг.4 - график функции f_cl( ).

На фиг.5 - график функции r_sc ( ).

На фиг.6 - вычисление координат конечной точки r₁ ОЭПО r₀Ar₁.

На фиг.7 - график сервисной функции d₁ ( ).

Устройство для формирования траектории перевода судна на новый курс содержит задатчик 1 абсолютной величины максимально допустимого сигнала _max управления, датчик 2 продольной скорости, задатчик 3 угла изменения курса, вычислитель 4 минимально допустимого радиуса кривизны траектории перехода на новый курс с тремя входами и одним выходом, датчик 5 координат центра масс судна, вычислитель 6 граничных параметров траектории перехода на новый курс с четырьмя входами и одним выходом, датчик 7 путевого угла, вычислитель 8 траектории перевода судна на новый курс, выполненный с возможностью вычисления двумерных коэффициентов полиномиальной кривой, являющейся траекторией перехода на новый курс, с одним входом и одним выходом

Выход задатчика 1 абсолютной величины максимально допустимого сигнала управления связан со вторым входом вычислителя 4, выход датчика 2 продольной скорости связан с третьим входом вычислителя 4, выход задатчика 3 угла изменения курса связан с первым входом вычислителя 4. Выход вычислителя 4 связан со вторым входом вычислителя 6, выход задатчика 3 угла изменения курса связан с первым входом вычислителя 6, выход датчика 5 координат центра масс судна связан с третьим входом вычислителя 6, выход датчика 7 путевого угла связан с четвертым входом вычислителя 6. Выход вычислителя 6 связан с входом вычислителя 8. Выход вычислителя 8 связан с входом авторулевого ли сигнал с выхода вычислителя поступает судоводителю, использующего траекторию перехода на новый курс в качестве исполнительной траектории.

На фиг.2 показана траектория перехода на новый курс r ₀Ar₁,

где r₀ , r₁ - координаты начальной и конечной точек траектории r₀Ar₁, соответственно,

- угол изменения курса,

- вектор скорости судна в начале траектории перехода на новый курс (см. фиг.2),

₀, ₁ - направления касательных в начальной и конечной точках траектории r₀Ar₁, соответственно.

В тоже время параметры ₀, ₁ являются путевыми углами судна в начальной и конечной точках траектории r₀Ar₁, соответственно, и курсами судна на прямых участках траектории, примыкающих к траектории r₀Ar₁.

Введем следующие обозначения.

U=|v₀ | - абсолютная величина путевой скорости судна,

_max - предельная величина перекладки руля при абсолютной величине продольной скорости судна U, обеспечивающая сохранение устойчивости.

- дифференциальное уравнение модели продольного движения судна,

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

Под элементарным полиномиальным отрезком (ЭПО) будем понимать полиномиальную кривую P₅(u) пятой степени в базисе Бернштейна [2], у которой кривизна в начальной и конечной точках равна нулю.

.

где {A₀, A₁, A₂, A₃, A₄, A₅} - двумерные коэффициенты,

- базисные полиномы Бернштейна пятой степени, обладающие повышенной вычислительной устойчивостью,

u - скалярный параметр, принимающий значения в диапазоне от 0 до 1.

Для траектории, состоящей из ЭПО и отрезков прямых, равенство нулю кривизны в граничных точках ЭПО обеспечивает физически реализуемый (безударный) переход судна с одного отрезка траектории на другой.

Будем считать, что абсолютная величина путевой скорости судна вдоль траектории U постоянна.

Задачу построения ЭПО перехода на новый курс будем рассматривать в декартовой системе координат, у которой ось X направлена на восток, а ось Y - на север. ЭПО однозначно определяется значениями следующих параметров в граничных точках [2].

{r₀, ₀,d₀,c₀,r₁, ₁,d₁,c₁},

где r_0,, r₁ - координаты начальной и конечной точек ЭПО, соответственно,

₀, ₁ - направления касательных в начальной и конечной точках ЭПО, соответственно,

d_0,, d ₁ - длины касательных в начальной и конечной точках ЭПО, соответственно,

c_0,, c₁ - кривизна в начальной и конечной точках ЭПО, соответственно, Значения следующих параметров выводятся из условий задачи:

₀ = arctg(v_0x/v_0y), ₁= ₀+ , c₀=0, c₁=0

где _0,, ₁ - направления касательных в начальной и конечной точках ЭПО, соответственно,

с_0,, c ₁ - кривизна в начальной и конечной точках ЭПО, соответственно.

- угол изменения курса,

- вектор скорости судна в начале траектории перехода на новый курс.

Задача построения ЭПО перехода на новый курс состоит в том, чтобы найти значения d₀, r₁, d₁, которые задают такую траекторию, что при управлении движением судна по этой траектории абсолютная величина отклонения руля не превышает _max.

Если заданы абсолютная величина путевой скорости U и ограничение на угол перекладки руля _max то минимальный радиус кривизны допустимой траектории перехода на новый курс R_m должен быть не меньше некоторой величины, определяемой дифференциальным уравнением модели продольного движения судна. Допустимые траектории перехода на новый курс можно искать среди ЭПО, которые строятся с помощью решения следующей экстремальной задачи. Найти такие d₀ и d₁, которые обеспечивают максимум минимального радиуса кривизны траектории перехода на новый курс ₁ при заданных r₀, r₁, r₀, r₁, ₀, ₁, c₀=0 и c₁=0 [2]. Элементарные полиномиальные отрезки, полученные в результате решения этой экстремальной задачи назовем оптимальными ЭПО (ОЭПО). Что бы условия экстремальной задача были полностью определены, необходимо задать расположение точки r₁. Примем условие, что ОЭПО должна иметь осевую симметрию. Для обеспечения осевой симметрии ОЭПО [2] точку r₁, будем располагать на луче, выходящем из точки r₀ под углом (см. фиг.6). Вследствие осевой симметрии ОЭПО длины касательных в начальной и конечной точках будут равны, т.е. d₀ =d₁.

ОЭПО, который обеспечивает изменение курса на угол , и при управлении движением судна по этой траектории абсолютная величина сигнала управления не будет превышать _max будем называть допустимым ОЭПО (ДОЭПО).

На основе результатов решения серии указанных экстремальных задач для лежащих в диапазоне от 2° до 180° и использования свойства подобия ЭПО были построены сервисные функции r_sc ( ), f_cl( ) и d₁( ). Сервисные функции определены для ЭПО с R_m =1. Сервисные функции описаны ниже.

С элементарным полиномиальным отрезком можно связать понятие задающей окружности. Задающая окружность это окружность, которая проходит через граничные точки r₀ и r₁ элементарного полиномиального отрезка r₀Ar₁ и является касательной к элементарному полиномиальному отрезку в этих точках (фиг.3).

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

На первый, второй и третий входы вычислителя 4 подаются: величина изменения курса , абсолютная величина максимально допустимого сигнала управления _max, абсолютная величина скорости движения судна U, соответственно.

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

Во внутренних точках ОЭПО, в которых угловая скорость судна максимальна по абсолютной величине, производная угловой скорости судна равна нулю . Следовательно, в указанных точках ОЭПО, дифференциальное уравнение модели продольного движения судна превращается в алгебраическое уравнение относительно _max, а именно 0=F( _max, _max). Из уравнения 0=F( _max, _max)в вычислителе 4 находится _max. Далее вычисляется минимальный радиус кривизны ОЭПО в этих точках.

где - минимальный радиус кривизны ОЭПО, который определяется максимальным углом перекладки руля во внутренних точках ОЭПО,

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

_max - максимальная угловая скорость судна в горизонтальной плоскости.

Т.к. в граничных точках ОЭПО с₀=с₁=0, то угловые скорости тоже равны нулю ( ₀= ₁=0). С помощью выражения в вычислителе 4 находится . Минимальный радиус кривизны ОЭПО , который определяется максимальным углом перекладки руля в граничных точках, вычисляется по следующей формуле

где - минимальный радиус кривизны ОЭПО, который определяется максимальным углом перекладки руля в граничных точках ОЭПО,

- угол изменения курса,

f_cl( ) - сервисная функция, график которой приведен на фиг.4,

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

- производная угловой скорости судна в горизонтальной плоскости в граничных точках.

В вычислителе 4 с помощью следующего выражения находится минимальный радиус кривизны R_m ОЭПО, который обеспечивает изменение курса на угол , и при управлении движением судна по этой траектории абсолютная величина сигнала управления не будет превышать _max

,

где R_m - минимальный радиус кривизны ДОЭПО,

- минимальный радиус кривизны ОЭПО, который определяется максимальным углом перекладки руля во внутренних точках ОЭПО,

- минимальный радиус кривизны ОЭПО, который определяется максимальным углом перекладки руля в граничных точках ОЭПО.

Результатом работы вычислителя 4 является минимальный радиус кривизны R_m ДОЭПО, который подается на выход.

На входы 1, 2, 3, и 4 вычислителя 6 подаются: величина изменения курса , минимальный радиус кривизны R_m ДОЭПО, координаты начальной точки ДОЭПО r₀, путевой угол в начальной точке ДОЭПО ₀, соответственно.

Вычислитель 6 выполняет расчет параметров ₀, ₁, r₁, d₀, d₁ , обеспечивающих формирование полного набора граничных параметров исполнительной траектории перехода на новый курс.

₁= ₀+ ,

где ₀ - путевой угол (курс) в начальной точке ДОЭПО перехода на новый курс,

₁ - путевой угол (курс) в конечной точке ДОЭПО,

- угол изменения курса.

Радиус задающей окружности R_sc (фиг.3) вычисляется по формуле

R_sc=R_mr_sc( ),

где R_m - минимальный радиус кривизны ДОЭПО,

- угол изменения курса,

r_sc( ) - сервисная функция, график которой приведен на фиг.5.

На фиг.5 показан график сервисной функции r_sc ( ).

Согласно фиг.6 координаты точки r ₁ могут быть вычислены с помощью следующего векторного выражения

где r₀,r₁ - координаты начальной и конечной точек траектории перехода на новый курс, соответственно,

R_sc - радиус задающей окружности,

- угол изменения курса,

R( /2) - матрица поворота двумерного вектора на угол,

₀ - вектор скорости судна в начале траектории перехода на новый курс.

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

d=R _md₁( ),

где d - длина касательных в начальной и конечной точках ДОЭПО,

R_m - минимальный радиус кривизны ДОЭПО,

- угол изменения курса,

d₁( ) - сервисная функция для вычисления длины касательных в граничных точках ОЭПО. График сервисной функции d₁ ( ) показан на фиг.7.

Вычислитель 6 подает на свой выход набор граничных параметров ДОЭПО, являющейся исполнительной траекторией перехода на новый курс

{r₀ , ₀,d,0,r₁, ₁,d,0}

где r₀, r ₁ - координаты начальной и конечной точек траектории перехода на новый курс, соответственно,

₀, ₁ - путевые углы в начальной и конечной точках траектории перехода на новый курс, соответственно,

d - длина касательных в начальной и конечной точках ДОЭПО.

Вычислитель 8 принимает на свой вход набор граничных параметров траектории перехода на новый курс. Выполняет преобразование набора граничных параметров траектории перехода на новый курс в двумерные коэффициенты полинома Р₅(u), задающего указанную траекторию. Преобразование выполняется по следующим формулам.

где A_i - двумерные коэффициенты полинома Р₅(u) (i = 0..5),

r₀ , r₁ - координаты начальной и конечной точек траектории перехода на новый курс, соответственно,

₀ , ₁ - путевые углы в начальной и конечной точках траектории перехода на новый курс, соответственно,

d - длина касательных в начальной и конечной точках ДОЭПО.

Результатом работы вычислителя 8 и всего устройства является набор коэффициентов {А₀, А₁ А ₂, A₃, А₄, А₅} полинома Р₅(u). Набор коэффициентов {А₀, А₁ А₂, A₃, А₄, А₅} является математическим представлением траектории перевода судна на новый курс. Набор коэффициентов {А₀, А₁ , А₂, A₃, A₄, А₅} с выхода вычислителя 8 поступает на вход авторулевого и/или индикатора отклонения от заданной траектории для использования его в качестве исполнительной траектории (задающего сигнала).

В работе авторулевого, как автоматической следящей системы управления движением судна, может быть использован любой алгоритм вычисления сигнала управления, предназначенный для управления движением судна по заданной криволинейной траектории, например, описанный в [3].

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

Список литературы

1. Fossen Thor I. Marine control systems. Marine Cybernetics. - Trondheim. Norway. - 2002.

2. Довгоброд Г.М., Клячко Л.М., Рогожников A.B. Использование параметрической аппроксимации при планировании траекторий движения аппаратов // Изв. Вузов. Приборостроение. 2009. Т.52. № 9. С.11-17.

3. Довгоброд Г.М. Разработка адаптивного алгоритма управления движением судна по криволинейной траектории с помощью метода попятного синтеза управления // Гироскопия и навигация. 2011. № 4. С.22-31.