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

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

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

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

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

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

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

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

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

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

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

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

На фиг.2 - траектория перевода судна на параллельный курс, состоящая из трех отрезков: криволинейного r₀Ar₁ (первый ДОЭПО), прямого отрезка r ₁r₂ и криволинейного r₂Br₃ (второй ДОЭПО).

На фиг.3 - траектория перехода на параллельную траекторию, состоящую из двух криволинейных отрезков r₀Ar₁ (первый ДОЭПО) и r₁Br ₂ (второй ДОЭПО).

На фиг.4 - основные параметры криволинейного отрезка траектории.

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

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

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

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

На фиг.9 - График функции _cl( ).

На фиг.10 - График функции h_c ( _c).

На фиг.11 - График функции h_b( _b).

На фиг.12 - График функции f_cl__jnv( ).

Устройство для формирования траектории перевода судна на параллельный курс с соблюдением ограничений на диапазон изменения сигнала управления содержит задатчик 1 (фиг.1) абсолютной величины максимально допустимого сигнала управления, датчик 2 продольной скорости, вычислитель 3 критических параметров траектории перевода судна на параллельный курс с двумя входами и двумя выходами, задатчик 4 расстояния смещения параллельного курса от текущего курса, вычислитель 5 приращения путевого угла , минимального радиуса кривизны R_m первого ДОЭПО, и длины L прямого отрезка между двумя ДОЭПО, с четырьмя входами и двумя выходами, датчик 6 координат центра масс судна, вычислитель 7 набора параметров граничных точек первого ДОЭПО с четырьмя входами и одним выходом, датчик 8 путевого угла, вычислитель 9 выходных параметров элементарных отрезков, составляющих траекторию перевода судна на параллельный курс, с двумя входами и одним выходом.

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

Траектория перехода на параллельный курс обязательно должна содержать участок схода с текущей траектории и участок выхода на параллельную траекторию. На фиг.2 показан общий случай траектории перевода судна на параллельный курс.

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

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

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

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

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

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

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

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

- величина приращения путевого угла при движении по криволинейному отрезку (фиг.2 и 3),

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

Н - расстояние смещения параллельного курса от текущего курса. Н>0 - смещение вправо по отношению к направлению исходной траектории. H<0 - смещение влево по отношению к направлению исходной траектории (фиг.2, 3).

H₁ - высота криволинейного отрезка (фиг.2 и 3),

H₂ - высота прямого отрезка между двумя ДОЭПО (фиг.2),

L - длина прямого отрезка между двумя ДОЭПО (фиг.2).

Будут рассматриваться два вида траекторий перевода судна на параллельный курс: траектория, состоящая из трех отрезков: криволинейного r₀Ar ₁, прямого отрезка r₁r₂ и криволинейного r₂Br₃ (фиг.2), и траектория, состоящая из двух криволинейных отрезков без прямой вставки (фиг.3),

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

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

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

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

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

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

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

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

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

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

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

{r₀, ₀, d₀, с₀, r₁ , ₁, d₁,с₁},

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

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

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

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

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

(1.2.2)

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

- приращение путевого угла,

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

Из [2] следует, что умножение каждого коэффициента А₀, А₁, А₂, A ₃, А₄, A₅ на число k 0 приводит к умножению на k параметров r₀, r ₁, d₀, d₁ и делению на k кривизны во всех точках полиномиальной кривой.

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

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

На основе результатов решения серии указанных экстремальных задач для , лежащих в диапазоне от _min=2° до 180°, и использования свойства подобия ЭПО были построены сервисные функции r_sc( ), _Cl( ), d₁( ), _Cl_inv_{_}( ) h_c( _c) и h_b( _b).

Сервисные функции определены для ОЭПО с R_m=1. Сервисные функции описаны ниже.

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

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

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

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

- приращение путевого угла,

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

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

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

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

- приращение путевого угла,

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

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

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

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

- приращение путевого угла,

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

ОЭПО однозначно определяется набором параметров граничных точек {r₀, ₀,d,0,r₁, ₁,d,0},

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

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

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

Для использования ОЭПО в алгоритмах управления необходимо вычислять координаты точек ОЭПО, координаты касательных векторов и кривизну для любого u [0,1]. Поэтому набор параметров в граничных точках необходимо преобразовать в двумерные коэффициенты полинома Р₅ (u) {А₀,А₁,А₂,А₃,А ₄,А₅}.

Преобразование выполняется по следующим формулам.

A₀=r₀ , A₁= ·d·(sin( ₀), cos( ₀))^T

А₂ =2-А₁+А₀

А₃=r ₁, А₄= ·(sin( ₁), cos( ₁))^T

А₅ =2*А₄+А₃ (1.4.1)

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

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

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

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

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

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

С помощью следующей формулы можно найти минимальный радиус кривизны R_m__c ОЭПО, обусловленный maxво внутренних точках ОЭПО.

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

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

В граничных точках ОЭПО, т.к. с₀=с₁=0, то угловые скорости тоже равны нулю ₀= ₁=0. Из соотношения _max=F( _max,0) можно найти _max. Минимальный радиус кривизны ОЭПО R _m__b, обусловленный максимальным углом перекладки руля в граничных точках, вычисляется по следующей формуле

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

- приращение путевого угла,

_cl( ) - сервисная функция с областью значений [18,48, 0,985] и областью определения [2°, 180°], график которой приведен на фиг.9,

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

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

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

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

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

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

Пусть известна высота Н₁ криволинейного отрезка (см. фиг.2 и 3). Из элементарной геометрии следует, что

где Н - расстояние смещения параллельного курса от текущего курса,

sign(x) - функция, равная: 1 при х>0, -1 при х<0, 0 при х=0,

H ₁ - высота криволинейного отрезка (см. фиг.2 и 3),

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

- приращение путевого угла.

Рассмотрим уравнение, полученное подстановкой (1.5.1) в (1.6.1)

где H₁ - высота криволинейного отрезка (фиг.2 и 3),

Н - расстояние смещения параллельного курса от текущего курса,

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

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

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

- приращение путевого угла. Рассмотрим уравнение, полученное подстановкой (1.5.2) в (1.6.1)

где Н₁ - высота криволинейного отрезка (см. фиг.2 и 3),

Н - расстояние смещения параллельного курса от текущего курса,

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

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

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

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

- приращение путевого угла.

Выражения (1.6.2) и (1.6.3) рассмотрим как уравнения для . Согласно разделу 5, необходимо выбрать для нахождения то уравнение, которому соответствует наибольший из двух радиусов R_m__c и R_m__b . Если найден, то, используя выражения (1.5.1), (1.5.2), (1.3.1), (1.3.2), можно будет рассчитать наборы параметров граничных точек двух ДОЭПО, входящих в траекторию перехода на параллельный курс.

Выделим из (1.6.2) и (1.6.3) функции h_c __inv( ) и h_b__inv( ), соответственно

h_c__inv ( )=r_sc( )(1-cos( ))

h_b__inv( )= _cl( )r_sc( )(1-cos( )),

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

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

- приращение путевого угла.

На основе функции h_c__inv( ) построена обратная к ней сервисная функция h_c ( _c) с областью значений [2°, 150°] и областью определения [0,00072, 2,223] (фиг.10). На основе функции h_b__inv( ) построена обратная к ней сервисная функция h_b ( _b) с областью значений [2°, 130°] и областью определения [0,01325, 3,549] (фиг.11).

Из (1.6.2) следует, что при и _c [0,00072, 2,223] угол изменения курса _c, обусловленный _maxво внутренних точках ОЭПО, с учетом правила знаков для H и равен

где Н₁ - высота криволинейного отрезка (фиг.2 и 3),

Н - расстояние смещения параллельного курса от текущего курса,

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

Аналогично, из (1.6.3) следует, что при и _b [0,01325, 3,549] угол изменения курса _b, обусловленный максимальным углом перекладки руля в граничных точках, равен

где Н₁ - высота криволинейного отрезка (фиг.2 и 3),

Н - расстояние смещения параллельного курса от текущего курса,

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

Рассмотрим диапазон возможных значений абсолютной величины приращения путевого угла _min | | _max. Для обеспечения совместимости областей значений функций h_c( _c) и h_b( _b) должны выполняться следующие условия: _min 2° и _max 130°.

Когда заданы _min, _max, то можно вычислить соответствующие им высоты H₁__min и H₁__max ДОЭПО. При вычислении указанных высот необходимо учитывать следующие разности минимальных радиусов кривизны

где для вычисления R_m_ _с используется правая часть выражения (1.5.1), для вычисления R_m__b используется правая часть выражения (1.5.2).

Если выполнено условие a) R_m__min 0, то

иначе

где H_{1_min} - абсолютная величина высоты ДОЭПО, когда приращение путевого угла равно _min,

Н - расстояние смещения параллельного курса от текущего курса,

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

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

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

- приращение путевого угла,

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

_cl( ) - сервисная функция, график которой приведен на фиг.9. Если выполнено условие б) R_m__max 0, то

иначе

где H₁__max - абсолютная величина высоты ДОЭПО, когда приращение путевого угла равно _max,

Н - расстояние смещения параллельного курса от текущего курса,

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

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

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

- приращение путевого угла,

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

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

Высоты H₁__min и H₁ __max задают диапазон возможных абсолютных значений высот ДОЭПО.

Если выполнено условие в) R_m__min<0 и R_m__max>0, то внутри диапазона возможных значений приращения путевого угла существует угол _кр, при котором R_m__c=R _m__b. Используя (1.5.1) и (1.5.2), получаем уравнение (6.11) для _кр

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

_{max -} абсолютная величина производной угловой скорости судна в горизонтальной плоскости в граничных точках, обусловленная _max,

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

Построена сервисная функция f_cl_ _inv( ) обратная к функции f_cl( ). _cl__inv( ) - сервисная функция имеет область значений [180°, 2°] и область определения [0,985, 18,48].

Функция _cl__inv( ) позволяет находить _кр при

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

Используя _кр, с помощью выражения (1.6.2) можно найти Н_кр

где Н_кр - абсолютная величина высоты ДОЭПО, при которой R_m__c=R_m __b, если выполнено условие в),

H - расстояние смещения параллельного курса от текущего курса,

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

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

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

- приращение путевого угла.

Критическими параметрами, определяющими способ вычисления и R_m, являются H₁__min , H_кр и H₁__max.

Если выполнено условие R_m__min R_m__max>0, то Н_кр не определено.

Если H₁__min <|H₁|<H₁__max, то, если |H₁|<H_кр, то для вычисления и R_m надо использовать (1.6.5) и (1.5.2), соответственно, иначе для вычисления и R_m использовать (1.6.4) и (1.5.1), соответственно.

Если выполнено условие a) R_m__min 0 и R_m__max 0, то для вычисления и R_m надо использовать (1.6.4) и (1.5.1), соответственно.

Если выполнено условие б) R_m__min 0 и R_m__max 0, то для вычисления и R_m надо использовать (1.6.5) и (1.5.2), соответственно.

Если |H|<2H₁__min, то

H=2sign(H)H_l__min

H₁=sign(H)H_l__min

L=0

Если |H|>2H_l__max , то

H₂=H-2H₁,

L=H₂/cos( - /2)

Если 2H₁__min<|H|<2H _l__max, то

H₁=sign(H)H/2,

L=0

где H - расстояние смещения параллельного курса от текущего курса,

H ₁__min - абсолютная величина высоты ДОЭПО, когда приращение путевого угла равно _min,

Н₁ - высота криволинейного отрезка,

H_l__max - абсолютная величина высоты ДОЭПО, когда приращение путевого угла равно _max.

L - длина прямого отрезка между двумя ДОЭПО,

- приращение путевого угла.

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

На первый и второй входы вычислителя 3 поступают: абсолютная величина максимально допустимого сигнала управления _maxи абсолютная величина скорости движения судна U, соответственно. Из уравнения 0=F( _max, _max) находится _max. С помощью выражения =F( _max, 0) вычисляется . Вычислитель 3 извлекает из памяти констант _min, _max и рассчитывает R_m__min и R_m__max с помощью выражений (1.6.6). Вычислитель 3 рассчитывает H₁__min по формуле (1.6.7), если выполнено условие а), иначе по формуле (1.6.8). Вычислитель 3 рассчитывает Н₁__max по формуле (1.6.9), если выполнено условие б), иначе по формуле (1.6.10). Если выполнено условие в), то вычислитель 3 по формуле (1.6.12) рассчитывает _кр и затем по формуле (1.6.13) рассчитывает Н_кр. Если выполнены условия а) и б), то Н_кр присваивается код - 1. Если условия а) и б) не выполнены, то Н_кр присваивается код - 2.

На первый выход вычислителя 3 подается набор критических параметров траектории

{H₁__min, H_кр, Н ₁__max},

где H₁_ _min - абсолютная величина высоты (что за высота) ДОЭПО, когда приращение путевого угла равно _min,

Н_кр - абсолютная величина высоты ДОЭПО, при которой R_m__c =R_m__b, если выполнено условие в); -1, если выполнены условия а) и б); -2, если условие а) не выполнено и условие б) не выполнено,

H₁__max - абсолютная величина высоты ДОЭПО, когда приращение путевого угла равно _max.

На второй выход вычислителя 3 подаются _maxи ,

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

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

На первый вход вычислителя 5 поступает расстояние смещения параллельного курса от текущего курса Н, на второй вход поступает набор критических параметров траектории (H₁__min, Н_кр, H ₁__max), на третий вход поступают _maxи , на четвертый вход поступает абсолютная величина скорости движения судна U. По алгоритму, указанному выше, выполняется расчет H₁ и L. и R_m. На первый выход подаются и R_m, на второй выход (какого блока) подается длина L прямого отрезка между двумя ДОЭПО.

На первый вход вычислителя 7 поступает расстояние смещения параллельного курса от текущего курса Н, на второй вход поступают и R_m, на третий вход поступают координаты центра масс судна r₀, на четвертый вход поступает путевой угол ₀. По формуле (1.2.3) выполняется расчет радиуса задающей окружности R_sc. По выражениям (1.2.2) выполняется расчет ₁ и присваиваются нулевые значения с₀ и с₁. По формуле (1.3.2) выполняется расчет длины d касательных в граничных точках ДОЭПО. На выход подается набор параметров граничных точек первого ДОЭПО

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

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

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

- приращение путевого угла.

На первый вход вычислителя 9 поступает набор параметров граничных точек первого ДОЭПО {r₀, ₀, d, 0, r₁, ₁, d, 0} и . На второй вход поступает длина L прямого отрезка между двумя ДОЭПО.

С помощью выражений (1.4.1) набор параметров первого ДОЭПО (2.1) преобразуется в набор М₀ двумерных коэффициентов полинома, задающего первый ДОЭПО,

M₀={A₀, А₁, А ₂, А₃, А₄, А₅}

Если L=0, то выполняются действия, описанные в разделе 2.1, иначе выполняются действия, описанные в разделе 2.2.

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

где r₀ - координаты начальной точки первого ДОЭПО,

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

r₂ - координаты конечной точки второго ДОЭПО,

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

₂ - направление касательных в конечной точке первого ДОЭПО, совпадающее с направлением касательной в начальной точке второго ДОЭПО,

- приращение путевого угла.

Вычислитель 9 формирует набор (2.3) параметров второго ДОЭПО

С помощью выражений (1.4.1) набор параметров второго ДОЭПО (2.3) преобразуется в набор M_t двумерных коэффициентов полинома, задающего второй ДОЭПО,

M₁={A₀, А₁, А ₂, А₃, А₄, А₅}.

Наборы двумерных коэффициентов M₀ и М₁ подаются на выход вычислителя 9. Траектория перевода судна на параллельный курс состоит из трех ДОЭПО (фиг.2). По формуле (2.4) выполняется расчет координат конечной точки r₂ прямого отрезка

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

L - длина прямого отрезка между двумя ДОЭПО,

- приращение путевого угла.

С помощью выражений (2.5) выполняется расчет набора граничных параметров второго ДОЭПО

где r₀ - координаты начальной точки первого ДОЭПО,

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

r₂ - координаты конечной точки прямого отрезка, совпадающей с начальной точкой второго ДОЭПО,

r₃ - координаты конечной точки второго ДОЭПО,

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

₂ - направление касательных в конечной точке первого ДОЭПО, совпадающее с направлением касательной в начальной точке второго ДОЭПО,

- приращение путевого угла.

Вычислитель 9 формирует набор М₁ координат граничных точек прямого отрезка

M₁={r₁,r₂ }

Вычислитель 9 формирует набор (2.6) параметров второго ДОЭПО

С помощью выражений (1.4.1) набор параметров второго ДОЭПО (2.7) преобразуется в набор М, двумерных коэффициентов полинома, задающего второй ДОЭПО,

Наборы М₀, М₁ и М₂ подаются на выход вычислителя 9.

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

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

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

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

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

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

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.