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

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

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

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

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

Известно устройство для проводки судна по узким участкам фарватера, которое содержит измерители вектора продольной скорости судна и скорости поворота корпуса судна в горизонтальной плоскости, измеритель координат и курса судна, внешнюю энергозависимую память, выходами соединенные с микроконтроллером. Устройство предоставляет судоводителю на экране в графической форме информацию о текущем и прогнозируемом положении судна относительно узкого участка фарватера и заданной прямолинейной траектории прохождения этого участка. Задача судоводителя при проводке судна по узкому участку фарватера состоит в том, чтобы с помощью органов управления рулем и тягой движителей судна удерживать условное изображение судна в границах фарватера, показанных на графическом экране (RU 2318187 С1, МПК G01C 21/14, опубликован 27.02.2008).

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

Наиболее близким к изобретению является устройство для проводки судна по узким участкам фарватеров, которое содержит датчик угла перекладки руля, датчик угловой скорости поворота судна, задатчик путевого угла, рулевое устройство судна, механически связанное с датчиком угла перекладки руля, автоматический регулятор путевого угла, первый вход которого соединен с выходом датчика угловой скорости поворота судна, второй вход автоматического регулятора путевого угла соединен с выходом датчика угла перекладки руля, а выход - с приводом рулевого устройства судна. Автоматический регулятор путевого угла содержит вычислитель бокового отклонения судна от заданной прямолинейной траектории, первый вход которого является третьим входом автоматического регулятора путевого угла, который соединен с первым входом приемника спутниковых навигационных систем с антенной, а второй вход вместе с первым входом блока оценки состояния судна и пятым входом сумматора является четвертым входом автоматического регулятора путевого угла, который соединен с выходом задатчика путевого угла (патент RU 2224279 С1, МПК 7 G01D 1/00, опубликован 20.02.2004).

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

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

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

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

На фиг.2 - функциональная схема автоматического регулятора путевого угла.

Устройство для проводки судна по узким участкам фарватера содержит автоматический регулятор 1 путевого угла (фиг.1), датчик 2 координат центра масс судна, датчик 3 путевого угла, датчик 4 угловой скорости поворота судна в горизонтальной плоскости, датчик 5 угла перекладки руля. Датчик путевого угла 2, датчик координат центра масс судна 3 и датчик угловой скорости 4 механически связаны с корпусом 7 судна. Датчик 5 угла перекладки руля механически связан с рулем 8 судна. Выходы датчика 4 угловой скорости поворота судна в горизонтальной плоскости, датчика 5 угла перекладки руля, датчика 3 путевого угла, датчика 2 координат центра масс судна соединены соответственно с первым, вторым, третьим и четвертым входами автоматического регулятора 1 путевого угла, выход которого соединен с входом рулевого привода 6.

Автоматический регулятор 1 путевого угла содержит блок 9 вычисления бокового отклонения судна от заданной прямолинейной траектории, первый вход которого является третьим входом автоматического регулятора 1 путевого угла, блок 10 постоянной памяти, в котором хранятся параметры заданной прямолинейной траектории и выход которого соединен со вторым входом блока 9 вычисления бокового отклонения судна от заданной прямолинейной траектории, блок 11 вычисления производной бокового отклонения судна от заданной прямолинейной траектории, вход которого соединен с выходом блока 9 вычисления бокового отклонения судна от заданной прямолинейной траектории; блок 12 вычисления интеграла бокового отклонения судна от заданной прямолинейной траектории, вход которого соединен с выходом блока 9 вычисления бокового отклонения судна от заданной прямолинейной траектории 9; первый блок 13 сравнения, первый вход которого соединен с выходом блока 11 вычисления производной бокового отклонения, второй вход блока 13 сравнения соединен с выходом блока 10 постоянной памяти; умножитель 14, первый вход которого соединен с выходом блока 13 сравнения, второй вход умножителя 14 соединен с выходом блока 12 вычисления интеграла бокового отклонения 12; блок 15 вычисления расчетного угла перекладки руля по линейному закону управления, первый и второй входы которого образуют четвертый и первый входы регулятора 1 путевого угла, соответственно, третий вход соединен с выходом умножителя 14, четвертый вход - с выходом блока 9 вычисления бокового отклонения, а пятый вход соединен с выходом блока 10 постоянной памяти; фильтр 16 низких частот, вход которого соединен с выходом блока 15 вычисления расчетного угла перекладки руля по линейному закону управления; второй блока сравнения 17, первый вход которого соединен с выходом блока 15 вычисления расчетного угла перекладки руля по линейному закону управления, а второй вход соединен со вторым выходом блока 10 постоянной памяти; третий блока 18 сравнения, первый вход которого соединен с выходом фильтра 16 низких частот, а второй вход соединен с выходом блока 10 постоянной памяти; блок 19 вычисления заданного угла перекладки руля, первый вход которого соединен с выходом блока 18 сравнения, а второй вход соединен с выходом фильтра 16 низких частот, третий вход соединен с выходом блока 15 вычисления расчетного угла перекладки руля по линейному закону управления, а четвертый вход соединен с выходом блока 17 сравнения; четвертый блок 20 сравнения, первый вход которого соединен с выходом блока 19 вычисления заданного угла перекладки руля, а второй вход соединен с выходом блока 10 постоянной памяти; вычислитель 21 сигнала управления, первый вход которого образует второй вход регулятора 1 путевого угла, а второй вход соединен с выходом блока 20 сравнения, а выход является выходом регулятора 1 путевого угла.

Устройство для проводки судна по узким участкам фарватера работает следующим образом. Для обеспечения работы устройства в блок 10 постоянной памяти записываются следующие параметры: координаты начала (широта _о и долгота ₀) и направление _ny0 заданного прямолинейного участка прохождения узкости и параметры, определяющие работу алгоритма управления: коэффициенты обратной связи (K_ny, K , K , K_I ) по путевому углу, по скорости поворота корпуса судна в горизонтальной плоскости, по боковому отклонению, по интегралу бокового отклонения соответственно; граничное значение производной бокового отклонения , порог зоны нечувствительности изменений расчетного угла перекладки руля

_гр1, порог сильного отклонения расчетного угла перекладки руля _гр2, причем _гр1 должно быть меньше _гр2. После этого в цикле выполняются следующие действия (счетчик цикла i указан в качестве нижнего индекса в обозначениях переменных). В блок вычисления 9 бокового отклонения из датчика 1 поступают текущие координаты центра масс судна ( _ci, _ci) и из блока 10 поступают параметры заданного прямолинейного участка прохождения узкости ( _ny0, ₀, ₀). Блок 9 вычисляет текущее боковое отклонение центра масс судна _i от заданной прямолинейной траектории, проходящей через заданный прямолинейный участок прохождения узкости. Из блока 9 текущее боковое отклонение _i поступает в блок вычисления 11 производной бокового отклонения и в нем производится вычисление производной текущего бокового отклонения , например по формуле:

,

где i - номер текущего шага управления;

- оценка производной бокового отклонения;

_i-3, _i-2, _i-1 - боковые отклонения, измеренные на предыдущих шагах цикла управления, указанных индексами;

_i - боковое отклонение, измеренное на текущем шаге цикла управления.

Из блока 9 текущее боковое отклонение _i поступает в блок 12 вычисления интеграла бокового отклонения, где производится вычисление интеграла бокового отклонения I _i, например, по формуле прямоугольников:

I _i:=0 при i=0,

где i - номер текущего шага управления;

I _i - текущее значение интеграла бокового отклонения;

I _i-1 - значение интеграла бокового отклонения на предыдущем шаге цикла управления;

_i - боковое отклонение, измеренное на текущем шаге цикла управления;

t - длительность данного шага цикла управления.

Из блока 11 производная текущего бокового отклонения поступает в блок сравнения 13, где производится вычисление значения числового признака s_i. Если ,

то s_i присваивается 1, иначе присваивается 0. Признак s_i обеспечивает обнуление интеграла бокового отклонения I _i в том случае, когда возникает необходимость перехода на новую траекторию движения, и боковое отклонение резко изменяет свою величину. В этом случае интеграл бокового отклонения I _i становится помехой, и он должен быть исключен с помощью обнуления из работы регулятора 1 до окончания процесса перехода на новую траекторию движения. Признаком окончания процесса перехода судна на новую траекторию является выполнение условия Из блока 13 значение признака

s_i поступает в умножитель 14, где умножается на значение интеграла бокового отклонения I _i, поступающее из блока 12. Из умножителя 14 в блок 15 вычисления расчетного угла перекладки руля по линейному закону управления поступает ноль или текущее значение интеграла бокового отклонения I _i. Из блока 10 памяти в блок 15 поступает направление заданной прямолинейной траектории _ny0. Из блока 9 вычисления бокового отклонения в блок 15 поступает текущее боковое отклонение _i. Из датчика 4 угловой скорости поворота корпуса судна в блок 15 поступает текущая угловая скорость _i. Из датчика 3 путевого угла в блок 15 поступает текущий путевой угол судна _nyi. В блоке 15 по соответствующей формуле вычисляется расчетное значение угла перекладки руля _pi.

где i - номер текущего шага управления;

_pi - расчетное значение угла перекладки руля;

K_ny, K , K , K_Iu - постоянные коэффициенты закона управления, которые определяются гидродинамическими характеристиками судна и требуемым качеством управления;

_ny0 - направление заданной прямолинейной траектории;

_nyi - текущий путевой угол судна;

_i - текущая угловая скорость;

I _i - текущее значение интеграла бокового отклонения.

Из блока 15 расчетное значение угла перекладки руля _pi, поступает в фильтр 16 низких частот, при этом вычисление расчетного значения угла перекладки руля осуществляется без высокочастотной шумовой составляющей _рнi, например, с помощью фильтра скользящего треугольного среднего по формуле:

_pнi:= _pi при i<4,

где i - номер текущего шага управления;

_рнi - расчетное значение угла перекладки руля без высокочастотной шумовой составляющей;

_pi-4, _pi-3, _pi-2, _pi-1 - расчетные значения угла перекладки руля, вычисленные на предыдущих шагах цикла управления, указанных индексами;

_pi - расчетное значение угла перекладки руля, вычисленное на текущем шаге цикла управления.

Из блока 9 расчетное значение угла перекладки руля _pi поступает в блок 17 сравнения, где производится вычисление значения числового признака s_pi. Если выполняется неравенство (5), то признаку s_pi присваивается 1, иначе присваивается 0.

где i - номер текущего шага управления;

_pi - расчетное значение угла перекладки руля на текущем шаге цикла управления;

_зi-1 - заданное значение угла перекладки руля на предыдущем шаге цикла управления;

_гр2 - второе граничное значение угла перекладки руля.

Числовой признак s_pi, обеспечивает использование расчетного угла перекладки руля _pi в качестве заданного _зi, при условии, что отклонение _pi от _зi-1 превысило порог сильного отклонения _гр2 (выполнено неравенство (5)).

Из фильтра 16 низких частот расчетное значение угла перекладки руля без высокочастотной шумовой составляющей _рнi поступает в блок 18 сравнения, где производится вычисление значения числового признака s_pнi. Если выполняется неравенство (6), то s_pнi присваивается 1, иначе присваивается 0.

где i - номер текущего шага управления;

_рнi - расчетное значение угла перекладки руля без высокочастотной шумовой составляющей на текущем шаге цикла управления;

_зi-1 - заданное значение угла перекладки руля на предыдущем шаге цикла управления;

_гр1 - первое граничное значение угла перекладки руля.

Числовой признак s_pнi обеспечивает использование расчетного угла перекладки руля без высокочастотной шумовой составляющей _рнi в качестве заданного _зi при условии, что отклонение _рнi от _зi-1 превысило порог зоны нечувствительности _гр1, но меньше порога сильного отклонения _pi от _зi-1 (выполнено неравенство (6) и не выполнено неравенство (5)).

Из блока 18 сравнения в блок 19 вычисления заданного угла перекладки руля поступает значение признака s_рнi. Из фильтра 16 низких частот в блок 19 поступает расчетное значение угла перекладки руля без высокочастотной шумовой составляющей _рнi. Из блока 15 в блок 19 поступает расчетное значение угла перекладки руля _pi. Из блока 17 в блок 19 поступает значение признака s_pi. В блоке 19 по формуле (7) производится вычисление заданного угла перекладки руля _зi

где i - номер текущего шага управления;

_зi - заданный угол перекладки руля;

s_pi - числовой признак, обеспечивающий использование расчетного угла перекладки руля _pi в качестве заданного _зi, при условии, что произошло резкое увеличение абсолютной величины расчетного угла перекладки руля (выполнено неравенство (5));

_pI - расчетный угол перекладки руля;

s_pнi - числовой признак, обеспечивающий использование расчетного угла перекладки руля без высокочастотной шумовой составляющей _pнi, в качестве заданного _зi при условии, что выполнено неравенство (6) и не выполнено неравенство (5);

_рнI - расчетный угол перекладки руля без высокочастотной шумовой составляющей;

_зi-1 - заданный угол перекладки руля, полученный на предыдущем шаге цикла управления; используется в качестве заданного _зi, при условии, что не выполнены неравенства (5) и (6).

Из блока 19 в блок 20 сравнения поступает значение заданного угла перекладки руля _зi. Если | _зi|> _amax, то _зi присваивается _amax·( _зi/| _зi|), иначе _зi, не изменяется. Из блока 20 в блок 21 вычисления сигнала управления поступает значение заданного угла перекладки руля _зi Из датчика 5 угла перекладки руля в блок 21 поступает текущее измеренное значение угла перекладки руля _ti. В блоке 21 выполняется вычисление значения сигнала управления u_i по формуле (8).

где i - номер текущего шага управления;

u_i - текущий сигнал управления;

_зi - заданный угол перекладки руля;

_ti - текущее измеренное значение угла перекладки руля.

Из блока 21 в рулевой привод 6 поступает сигнал управления u_i для отработки необходимой перекладки руля.

Текущие значения всех используемых величин хранятся в оперативной памяти УПС.

Известно, что наличие в законе управления члена, пропорционального интегралу бокового отклонения, обеспечивает астатизм регулятора при действии постоянного возмущающего момента и постоянной боковой силы при движении по прямолинейной траектории. Однако присутствие члена, пропорционального интегралу бокового отклонения, приводит к увеличению перерегулирования и времени переходного процесса при выводе судна на прямолинейную траекторию. Использование блоков 11, 13 и умножителя 14 в регуляторе 1 обеспечивает отключение (обнуление) в законе управления члена, пропорционального интегралу бокового отклонения, что обеспечивает сокращение дистанции вывода судна на заданную прямолинейную траекторию прохождения узкости.

Обычно в выходном сигнале закона управления присутствуют высокочастотные шумы, которые приводят к перегрузке привода руля и практически не влияют на траекторию движения судна. Непосредственное применение фильтра низких частот к выходному сигналу закона управления позволяет избавиться от высокочастотных шумов, но ведет к дополнительной задержке сигнала управления и способствует уменьшению запаса устойчивости всего контура управления. Использование фильтра 16, блоков 17, 18 и 19 в регуляторе 1 обеспечивает существование зоны нечувствительности при малых изменениях выходного сигнала закона управления. Когда | _рнi- _зi| _гр1, заданное значение угла перекладки руля не изменяется. Если выходной сигнал закона управления изменяется на значительную величину (| _pi- _зi|> _гр2), то это значение сразу становится заданной величиной угла перекладки руля, что обеспечивает минимальное время задержки сигнала управления. В остальных случаях заданной величиной угла перекладки руля становится отфильтрованное (без высокочастотной составляющей) значение расчетного угла перекладки руля.

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