RU2525606C1 - Device and method for automatic control of scheduled vessel movement - Google Patents

Device and method for automatic control of scheduled vessel movement Download PDF

Info

Publication number
RU2525606C1
RU2525606C1 RU2013105883/11A RU2013105883A RU2525606C1 RU 2525606 C1 RU2525606 C1 RU 2525606C1 RU 2013105883/11 A RU2013105883/11 A RU 2013105883/11A RU 2013105883 A RU2013105883 A RU 2013105883A RU 2525606 C1 RU2525606 C1 RU 2525606C1
Authority
RU
Russia
Prior art keywords
angle
control
signal
input
fed
Prior art date
Application number
RU2013105883/11A
Other languages
Russian (ru)
Other versions
RU2013105883A (en
Inventor
Лев Михайлович Клячко
Генрих Эразмович Острецов
Original Assignee
Открытое акционерное общество "Центральный научно-исследовательский институт "Курс" (ОАО "ЦНИИ "Курс")
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Открытое акционерное общество "Центральный научно-исследовательский институт "Курс" (ОАО "ЦНИИ "Курс") filed Critical Открытое акционерное общество "Центральный научно-исследовательский институт "Курс" (ОАО "ЦНИИ "Курс")
Priority to RU2013105883/11A priority Critical patent/RU2525606C1/en
Application granted granted Critical
Publication of RU2525606C1 publication Critical patent/RU2525606C1/en
Publication of RU2013105883A publication Critical patent/RU2013105883A/en

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

FIELD: transport.
SUBSTANCE: system includes receiver (1) of satellite navigation system, route selector (2) with outputs of the set path angle (PA) signal and the set angle φset of course angle, adjuster (3) of rudder displacement angle δset, steering gear (4), adjuster (5) of propeller shaft rpm nset, propeller shaft drive (6), adjuster (7) of maneuvering device rpm nman, maneuvering device (8), comparison unit (9), differential unit (10), control law correction unit (11) for rudder displacement angle δ, propeller shaft rpm nset, maneuvering device rpm nman, unit (12) of path angle (PA) vector position limit values four sectors, control ratio generator (13) and vessel (14) which all are interconnected. The system implements standard and precise control of vessel movement depending on results of comparison of difference between path angle (PA) from satellite navigation system receiver (1) and the set course signal φset from route selector (1) with constant C and on position of path angle (PA) vector in corresponding zone of path angle (PA) signal four limit values, thus determining adjustment ratios for each of three channels of vessel control.
EFFECT: higher accuracy and safety of scheduled vessel movement control.
2 cl, 1 dwg

Description

Изобретение относится к области судовождения и может быть использовано для автоматического управления движением судна с использованием в качестве основной информации о состоянии судна текущих широты и долготы.The invention relates to the field of navigation and can be used to automatically control the movement of the vessel using current latitude and longitude as the main information about the condition of the vessel.

Известна система автоматического управления судном, содержащая задатчик путевого угла, блок формирования путевого угла и бокового сноса судна, блок формирования угловой скорости и датчик угла и перекладки руля. Выход задатчика путевого угла и первый выход блока формирования путевого угла и бокового сноса судна подключены через блок формирования приращения к первому входу рулевого привода, ко второму и к третьему входам которого подключены соответственно выходы блока формирования угловой скорости и датчика угла перекладки руля (патент RU 2240953 C1, B63H 25/04, 27.11.2004 г.) В известной системе управление движением судна осуществляют по сигналам текущего путевого угла, заданного путевого угла и угловой скорости судна, на основании которых формируется закон управления рулевым приводом судна.A known system for automatic control of a vessel comprising a track angle adjuster, a block for forming a track angle and lateral drift of a ship, a block for forming an angular velocity, and an angle and rudder sensor. The output of the path angle adjuster and the first output of the path angle and side drift formation unit are connected through the increment formation unit to the first input of the steering gear, the outputs of the angular speed formation unit and the rudder angle sensor are connected respectively to the second and third inputs of it (patent RU 2240953 C1 , B63H 25/04, 11/27/2004) In the known system, the movement of the ship is controlled by the signals of the current track angle, the set track angle and the angular velocity of the ship, based on which the law is formed at board steering ship.

Известно также устройство для управления судном по расписанию, содержащее канал регулирования угла δ перекладки руля судна, канал регулирования оборотов n гребного вала судна, приемник спутниковой навигационной системы (CHC), выход сигнала путевого угла (ПУ) которого подключен к первому входу канала регулирования угла δ перекладки руля, а выход скорости V судна указанного приемника - к первому входу канала регулирования оборотов n гребного вала, задатчик маршрута, выход заданного угла узд курса которого подключен ко второму входу канала регулирования угла перекладки руля, а выход заданной скорости φзд задатчика маршрута судна - к первому входу канала регулирования оборотов n гребного вала, способ автоматического управления движением судна (патент RU 2292289 C1, Б.И. №3, 27.01. 2007 г.), принятый в качестве прототипа,There is also known a device for controlling a ship according to a schedule, comprising a channel for controlling the angle δ of the rudder, a channel for controlling the speed n of the propeller shaft of the satellite receiver of the satellite navigation system (CHC), the output of the signal of the track angle (PU) of which is connected to the first input of the channel for adjusting the angle δ rudder shifts, and the output of the vessel V speed of the specified receiver to the first input of the speed control channel n of the propeller shaft, the route adjuster, the output of a given angle of which the bridle of the course is connected to the second input of the reg adjusting the rudder angle, and the output of the given speed φ rear of the vessel route setter - to the first input of the speed control channel n of the propeller shaft, a method for automatically controlling the movement of the vessel (patent RU 2292289 C1, B.I. No. 3, January 27, 2007), adopted as a prototype,

В указанном устройстве автоматическое управление движением судна осуществляется аналогично описанному выше, но с дополнительной корректировкой заданного значения путевого угла в процессе плавания из точки «А» в точку «Б», затем в точку «В»… по заданному маршруту.In the specified device, the automatic control of the vessel’s movement is carried out similarly to the one described above, but with additional adjustment of the set value of the track angle during navigation from point “A” to point “B”, then to point “C” ... along the given route.

Известные системы и способы автоматического управления движением судна обеспечивают движение судна по заданному направлению.Known systems and methods for automatically controlling the movement of the vessel provide the movement of the vessel in a given direction.

Недостатками указанных устройств и способа управления судном являются:The disadvantages of these devices and the method of controlling the vessel are:

- отсутствие контроля за нахождением судна в заданной точке траектории в заданное время, т.е. не контролируется совпадение заданного положения судна в пространстве и во времени с текущим положением,- lack of control over the location of the vessel at a given point in the trajectory at a given time, i.e. the coincidence of the given position of the vessel in space and time with the current position is not controlled,

- при появлении поперечных возмущающих силовых воздействий на судно создается большой угол дрейфа судна, что приводит к уходу с заданной траектории движения, а также к экономическим и временным потерям; так как в качестве основной информации используется не координатная информация о местоположении судна, а его угловое направление движения,- when transverse disturbing force effects on the vessel appear, a large drift angle of the vessel is created, which leads to departure from a given trajectory of movement, as well as to economic and temporary losses; since the basic information is not the coordinate information about the location of the vessel, but its angular direction of movement,

- использование только кормового рулевого привода для управления движением судна по заданной траектории создает дополнительный угол дрейфа в процессе изменения направления движения судна, который приводит также к дополнительным отклонениям от заданной траектории в поперечной плоскости судна,- the use of only aft steering gear to control the movement of the vessel along a given trajectory creates an additional drift angle in the process of changing the direction of movement of the vessel, which also leads to additional deviations from a given trajectory in the transverse plane of the vessel,

- затруднен проход судном узкостей из-за появления угла дрейфа и бокового сноса судна относительно заданной траектории движения.- the narrowing of the vessel due to the appearance of the drift angle and lateral drift of the vessel relative to a given trajectory of movement is difficult.

Техническим результатом изобретения является повышение точности, экономичности управления движением судном по расписанию, безопасности проводки судна в узкостях и обеспечение возможности перехода на типовое (штатное) управление движением судна при наличии возмущающих сил в поперечном направлении судна.The technical result of the invention is to increase the accuracy, cost-effectiveness of controlling the movement of the vessel on schedule, the safety of the wiring of the vessel in the narrowness and providing the possibility of transition to the standard (full-time) control of the movement of the vessel in the presence of disturbing forces in the transverse direction of the vessel.

Технический результат достигается тем, что в устройство для управления судном по расписанию, содержащее канал регулирования угла δ перекладки руля судна, канал регулирования оборотов n гребного вала судна, приемник спутниковой навигационной системы (CHC), выход сигнала путевого угла (ПУ) которого подключен к первому входу канала регулирования угла δ перекладки руля, а выход скорости V судна указанного приемника - к первому входу канала регулирования оборотов n гребного вала, задатчик маршрута, выход заданного угла φзд курса которого подключен ко второму входу канала регулирования угла перекладки руля, а выход заданной скорости Vзд. задатчика маршрута судна - к первому входу канала регулирования оборотов n гребного вала, введены подруливающее устройство судна, регулятор оборотов nподр подруливающего устройства, образующих канал регулирования оборотов nподр подруливающего устройства судна, формирователь коэффициентов законов управления, блок четырех секторов граничных значений углов положения вектора ПУ:The technical result is achieved by the fact that in the device for controlling the vessel according to the schedule, containing the channel for adjusting the angle δ of the rudder of the vessel, the channel for controlling the speed n of the propeller shaft of the vessel, the satellite navigation system (CHC) receiver, the output of the signal of the track angle (PU) of which is connected to the first Valid channel adjustment angle δ rudder speed V and the output of said receiver vessel - to the first input channel adjustment of revolutions n of the propeller shaft, the route setting unit, the output angle φ zd predetermined rate which Con ene to the second input channel adjusting rudder angle, and the predetermined output speed V zd. Setpoint vessel route - to the first input channel adjustment of revolutions n of the propeller shaft, introduced thruster vessel apparatus revolutions n consecutive regulator thruster forming n consecutive speed control channel thruster vessel device driver control laws coefficient block four sectors boundary values angles vector position PU :

«а)» (-π/4)=+7π/4 < угол вектора ПУ < + π/4, или“A)” (-π / 4) = + 7π / 4 <angle of the vector of the PN <+ π / 4, or

«б)» +π/4 < угол вектора ПУ < +3π/4, или“B)” + π / 4 <angle of the vector of the control vector <+ 3π / 4, or

«в)» +3π/4 < угол вектора ПУ < +5π/4, или“C)” + 3π / 4 <angle of the PN vector <+ 5π / 4, or

«г)» +5π/4 < угол вектора ПУ < +7π/4=(-π/4),"D)" + 5π / 4 <angle of the vector of the control vector <+ 7π / 4 = (- π / 4),

блок сравнения, блок разностей и блок коррекции законов управления угла δ перекладки руля, оборотов n гребного вала, оборотов nподр подруливающего устройства, выход ПУ приемника CHC и выход заданного угла φзд курса задатчика маршрута подключены к входам блока сравнения, выполненного с возможностью формирования модуля разности |ПУ-φзд| на выходе, который соединен с первым входом блока разностей, второй вход которого подключен к выходу формирования текущей широты Ф или долготы γ судна приемника CHC, а третий - к выходу заданного угла φзд курса задатчика маршрута, который соединен с первым входом блока коррекции законов управления указанных каналов регулирования, второй, третий, четвертый и пятый входы которого соединены соответственно с выходом блока разностей, с выходом формирователя коэффициентов законов управления, с выходом указанного блока четырех секторов, с выходом сигнала угла курса φ из приемника CHC, который соединен с первым входом формирователя коэффициентов законов регулирования и входом блока четырех секторов граничных значений углов положения вектора ПУ, второй вход формирователя коэффициентов законов управления подключен ко второму выходу блока разности, а выход указанного блока коррекции - к третьим входам канала регулирования угла δ перекладки руля и канала регулирования оборотов гребного вала и входу канала регулирования подруливающего устройства судна.a comparison unit block differences and the correction unit control laws angle δ rudder of revolutions n of the propeller shaft revolutions n consecutive thruster UE receiver output CHC and output the predetermined angle φ zd rate set point of the route connected to the inputs of the comparison unit configured to form a module differences | PU-φ health | at the output, which is connected to the first input of the difference block, the second input of which is connected to the output of the formation of the current latitude Ф or longitude γ of the vessel of the receiver CHC, and the third to the output of the given angle φ h of the course setter, which is connected to the first input of the control law correction block the specified control channels, the second, third, fourth and fifth inputs of which are connected respectively with the output of the difference block, with the output of the shaper of the coefficients of control laws, with the output of the specified block of four sectors, with the output m of the angle signal φ from the receiver CHC, which is connected to the first input of the shaper of the coefficients of the regulation laws and the input of the block of four sectors of the boundary values of the angles of the position of the vector of the PU, the second input of the shaper of the coefficients of the control laws is connected to the second output of the difference block, and the output of the specified correction block is connected to the third inputs of the channel for controlling the angle δ of the rudder shift and the channel for controlling the speed of the propeller shaft and the input of the channel for regulating the thruster of the vessel.

Технический результат в способе обеспечивается тем, что в способе автоматического управления движением судна по расписанию, в котором сигналы путевого угла ПУ и скорости хода судна V из приемника CHC подают на входы каналов регулирования угла δ рулевого привода и на вход канала регулирования оборотов n привода гребного вала соответственно, сигналы заданного угла φЗ курса . и заданной скорости Vзд. хода из задатчика маршрута подают в канал регулирования угла δ рулевого привода и в канал регулирования оборотов n привода гребного вала соответственно, в которых формируют законы типового управления указанными параметрами, сигнал путевого угла ПУ из приемника CHC и сигнал заданного угла φзд курса из задатчика маршрута сравнивают в блоке сравнения, на выходе которого формируют модуль разности |ПУ-φзд|, который сравнивают с постоянной C, если выполняется условие |ПУ-φзд|>C, то через интервалы времени Δt повторяют операцию сравнения сигнала модуля |ПУ-φзд| с постоянной C до тех пор, пока указанное условие |ПУ-φзд|>C выполняется; если выполняется условие |ПУ-φзд|≤C, осуществляют корректировку сформированных ранее законов управления угла δ рулевого привода и оборотов n привода гребного вала, для этого в блоке разностей формируют сигналы разности текущей широты Ф и заданной широты Фзд судна и текущей долготы γ и заданной долготы γзд судна из задатчика маршрута, которые подают в блок коррекции законов управления; в блоке четырех секторов путевого угла формируют зоны четырех сектора граничных значений вектора ПУ:The technical result in the method is ensured by the fact that in the method of automatically controlling the vessel’s movement according to a schedule, in which the signals of the steering angle of the launcher and the speed of the vessel V from the receiver CHC are fed to the inputs of the angle control channels δ of the steering drive and to the input of the speed control channel n of the propeller shaft drive accordingly, the signals of a given angle φ З of the course . and a given speed V Zd . stroke of the setpoint path is fed into the channel adjustment angle δ of the steering actuator and speed control n drive propeller shaft passage, respectively, which form the model control laws specified parameters, track angle PU signal from the receiver CHC signal and the predetermined angle φ zd rate of setpoint route compared in the comparison unit, at the output of which the difference module | PU-φ zd | is formed, which is compared with the constant C, if the condition | PU-φ zd |> C is fulfilled, then the signal comparison operation is repeated at time intervals Δt module | PU-φ health | with constant C until the indicated condition | PU- φw |> C is satisfied; if the condition | zd PU-φ | ≤C, formed previously performed adjustment of the steering control laws and drive δ n revolutions of the propeller drive shaft, this difference in block form the difference signals, and current latitude F F zd given latitude and the present longitude vessel γ and a predetermined longitude γ setpoint bld vessel from the route which is fed to correction unit control laws; in the block of four sectors of the track angle form the zone of four sectors of the boundary values of the vector PU:

«а)» (-π/4)=+7π/4 < угол вектора ПУ < +π/4, или“A)” (-π / 4) = + 7π / 4 <angle of the vector of the PN <+ π / 4, or

«б)» +π/4 < угол вектора ПУ < +3π/4, или“B)” + π / 4 <angle of the vector of the control vector <+ 3π / 4, or

«в)» +3π/4 < угол вектора ПУ < +5π/4, или“C)” + 3π / 4 <angle of the PN vector <+ 5π / 4, or

«г)» +5π/4 < угол вектора ПУ < +7π/4=(-π/4),"D)" + 5π / 4 <angle of the vector of the control vector <+ 7π / 4 = (- π / 4),

определяют, в каком из указанных секторов находится в данный момент времени вектор путевого угла ПУ и вводят граничные значения ПУ соответствующего выявленного сектора в формирователь коэффициентов законов управления и блок коррекции законов управления, при этом:determine in which of the indicated sectors the path vector of the control path vector is located at a given moment of time and enter the boundary values of the control gear of the corresponding identified sector into the generator of coefficients of control laws and the block of correction of control laws, while:

если вектор ПУ находится в зоне а), то в формирователе коэффициентов законов управления формируют:if the PU vector is in zone a), then in the generator of coefficients of control laws form:

коэффициенты K1 и K 1 . 1

Figure 00000001
с использованием констант C1, C 1 1
Figure 00000002
и сигнала угла курса φ из приемника CHC:coefficients K 1 and K one . one
Figure 00000001
using constants C 1 , C one one
Figure 00000002
and the heading angle signal φ from the receiver CHC:

K1=C1/cos(φ),K 1 = C 1 / cos (φ),

K 1 1 = C 1 1 /cos ( ϕ )

Figure 00000003
, K one one = C one one / cos ( ϕ )
Figure 00000003
,

которые вводят в блок коррекции законов управления угла δ перекладки руля, оборотов n гребного вала, оборотов nподр подруливающего устройства, где формируют сигнал коррекции закона управления угла δ рулевого привода:are inputted to the block compensation control laws angle δ rudder propeller shaft revolutions n, n consecutive rotations of the steering device, wherein the correction signal is formed angle δ of the steering actuator control law:

Δ δ к о р р . = K 1 ( γ γ з д ) + K 1 1 d ( γ γ з д ) / d t

Figure 00000004
, Δ δ to about R R . = K one ( γ - γ s d ) + K one one d ( γ - γ s d ) / d t
Figure 00000004
,

который вводят в канал регулирования угла δ рулевого привода, а сигналы K1(ПУ-φзд)+K2ω, где ω - угловая скорость судна, из приемника CHC и задатчика маршрута, отключают от канала регулирования угла δ рулевого привода;which is introduced into the channel for adjusting the angle δ of the steering drive, and the signals K 1 (PU-φ rear ) + K 2 ω, where ω is the angular velocity of the vessel, from the receiver CHC and the route setter, are disconnected from the channel for adjusting the angle δ of the steering drive;

коэффициент регулирования K2 с использованием константы G2 и сигнала угла курса φ из приемника CHC:control factor K 2 using constant G 2 and a course angle signal φ from the receiver CHC:

K2=C2/cos(φ),K 2 = C 2 / cos (φ),

который вводят в блок коррекции законов управления для формирования сигнала коррекции закона управления оборотами гребного вала Δnзд.:which is introduced into the block of correction of control laws to generate a signal for the correction of the law of control of the speed of the propeller shaft Δn rear :

Δnзд.=-K2(Ф-Фзд),Δn bldg. = -K 2 (f- f rear ),

который вводят в канал регулирования оборотов n гребного вала:which is introduced into the speed control channel n of the propeller shaft:

nзд.=Δnзд+K1(V-Vзд)+f(n,V);n building = Δn zd + K 1 (VV zd ) + f (n, V);

коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника CHC:control coefficient K 3 using constant C 3 and a course angle signal φ from the receiver CHC:

K3=C3/cos(φ),K 3 = C 3 / cos (φ),

в блоке коррекции законов управления формируют сигнал заданных оборотов nподр. зд подруливающего устройства:in the block of correction of control laws form a signal of the given revolutions n sub. rear thruster:

nподр.зд.=-K3(γ-γзд),n undercarriage = -K 3 (γ-γ zd ),

который подают на вход канала регулирования оборотов nподр подруливающего устройства;which is fed to the input of the speed control channel n consecutive steering device;

если вектор ПУ находится в зоне сектора б), то в формирователе коэффициентов законов управления формируют:if the PU vector is in the sector of sector b), then in the shaper of coefficients of control laws form:

коэффициенты регулирования K1 и K 1 . 1

Figure 00000001
c использованием констант C1, C 1 1
Figure 00000002
и сигнала угла курса φ из приемника CHC:control factors K 1 and K one . one
Figure 00000001
using constants C 1 , C one one
Figure 00000002
and the heading angle signal φ from the receiver CHC:

K1=C1/cos(180°-φ),K 1 = C 1 / cos (180 ° -φ),

K 1 1 = C 1 1 / c o s ( 1 8 0 o - ϕ )

Figure 00000005
, K one one = C one one / c o s ( one 8 0 o - ϕ )
Figure 00000005
,

которые подают в блок коррекции законов управления, где формируют закон управления рулевым приводом:which are fed to the block of correction of control laws, where they form the law of steering control:

Δ δ к о р р . = K 1 ( γ γ з д ) K 1 1 d ( γ γ з д ) / d t

Figure 00000006
, Δ δ to about R R . = - K one ( γ - γ s d ) - K one one d ( γ - γ s d ) / d t
Figure 00000006
,

который подают в канал регулирования угла δ рулевого привода, а сигналыwhich is fed into the steering angle control channel δ of the steering gear, and the signals

K1(ПУ-φзд)+K2ω из приемника CHC и задатчика маршрута отключают от канала регулирования угла δ рулевого привода;K 1 (PU-φ rear ) + K 2 ω from the receiver CHC and the route setter are disconnected from the channel for controlling the angle δ of the steering drive;

коэффициент регулирования K2 с использованием константы C2 и сигнала угла курса φ из приемника CHC:control factor K 2 using constant C 2 and a course angle signal φ from the receiver CHC:

K2=C2/cos(180°-φ),K 2 = C 2 / cos (180 ° -φ),

который подают в блок коррекции законов управления для формирования сигнала коррекции закона управления оборотами Δnзд гребного вала nподр;which is fed to the correction block of control laws to generate a correction signal of the speed control law Δn of the rear shaft of the propeller n sub ;

Δnзд.=K2(Ф-Фзд),Δn bld. = K 2 (f- f rear ),

который вводят на вход канала регулирования оборотами n гребного вала, где формируют сигнал задания оборотов nзд гребного вала:which is introduced to the input channel adjustment revolutions n of the propeller shaft, wherein the reference signal is formed of revolutions n of the propeller shaft zd:

nзд.=Δnзд+K1(V-Vзд).+f(n,V);n building = Δn zd + K 1 (VV zd ) . + f (n, V);

коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника CHC:control coefficient K 3 using constant C 3 and a course angle signal φ from the receiver CHC:

K3=C3/cos(180°-φ),K 3 = C 3 / cos (180 ° -φ),

который подают в блок коррекции законов управления, где формируют сигнал заданных оборотов nподр. зд подруливающего устройства:which is fed into the correction block of control laws, where a signal of predetermined revolutions n subr. rear thruster:

nподр.зд.=K3(γ-γзд),n undercarriage = K 3 (γ-γ zd ),

который подают в канал регулирования оборотов nподр подруливающего устройства;which is fed to the speed control channel n consecutive steering device;

если вектор ПУ находится в секторе в), то в формирователе коэффициентов законов управления формируют:if the PU vector is in sector c), then in the shaper of coefficients of control laws form:

коэффициент регулирования K4 с использованием константы C4 и сигнала угла курса φ из приемника CHC:control factor K 4 using constant C 4 and a course angle signal φ from the receiver CHC:

K4=C4/cos(90°-φ),K 4 = C 4 / cos (90 ° -φ),

который вводят в блок коррекции законов управления, где формируют сигнал управления рулевым приводом Δδкорр which is introduced into the block of correction of control laws, where they form the steering signal Δδ corr

Δδкорр=-K4(Ф-Фзд),Δδ corr = -K 4 (f- f rear ),

который подают на вход канала регулирования угла δ рулевого привода, а сигналы K1(ПУ-φзд)+K2ω, подаваемые на вход канала регулирования угла δ рулевого привода из приемника CHC и задатчика маршрута, отключают;which is fed to the input of the channel for adjusting the angle δ of the steering drive, and the signals K 1 (PU-φ rear ) + K 2 ω supplied to the input of the channel for adjusting the angle δ of the steering drive from the receiver CHC and the route setter are turned off;

коэффициент регулирования K5 с использованием константы C5, и сигнала угла курса φ из приемника CHC:control factor K 5 using the constant C 5 and the heading angle signal φ from the receiver CHC:

K5=C5/cos(90°-φ),K 5 = C 5 / cos (90 ° -φ),

который подают в блок коррекции законов управления для формирования сигнала коррекции оборотов Δnзд гребного вала:which is fed to the correction block of the control laws for generating a signal for the correction of revolutions Δn of the rear shaft:

Δnзд.=-K5(γ-γзд),Δn bldg. = -K 5 (γ-γ zd ),

который подают на вход канала регулирования оборотов n гребного вала где формируют закон управления:which is fed to the input of the speed control channel n of the propeller shaft where the control law is formed:

nзд.=Δnзд+K1(V-Vзд)+f(n,V.);n building Zd = Δn + K 1 (VV zd) + f (n, V. );

коэффициент регулирования K3 с использованием константы С3 и сигнала угла курса - φ из приемника CHC:control coefficient K 3 using constant C 3 and a heading angle signal - φ from the receiver CHC:

K3=C3/cos(90°-φ),K 3 = C 3 / cos (90 ° -φ),

который подают в блоке коррекции законов управления, где формируют сигнал скорости nподр. зд подруливающего устройства:which is served in the block of correction of control laws, where they form a signal of speed n sub. rear thruster:

nподр.зд.=K3(Ф-Фзд),n undercarriage = K 3 (f- f rear ),

который подают на вход канала регулирования оборотов nподр подруливающего устройства, который вводят в подруливающее устройство;which is fed to the input channel adjustment revolutions n consecutive steering device, which is introduced into the thruster;

если вектор ПУ находится в зоне сектора г), то в формирователе коэффициентов законов управления формируют:if the PU vector is in the zone of sector d), then in the shaper of coefficients of control laws form:

коэффициент регулирования K4 с использованием константы C4 и сигнала угла курса φ из приемника CHC:control factor K 4 using constant C 4 and a course angle signal φ from the receiver CHC:

K4=C4/cos(270°-φ),K 4 = C 4 / cos (270 ° -φ),

который подают в блок коррекции законов управления, где формируют сигнал управления рулевым приводом Δδкорр:which is fed to the correction block of the control laws, where they form the steering signal control Δδ corr :

Δδкорр=-K4(Ф-Фзд),Δδ corr = -K 4 (f- f rear ),

который подают на вход канала регулирования угла δ рулевого привода, а сигналы K1(ПУ-φзд)+K2ω, подаваемые на вход канала регулирования угла δ рулевого привода из приемника CHC и задатчика маршрута, отключают;which is fed to the input of the channel for adjusting the angle δ of the steering drive, and the signals K 1 (PU-φ rear ) + K 2 ω supplied to the input of the channel for adjusting the angle δ of the steering drive from the receiver CHC and the route setter are turned off;

коэффициент регулирования K5 с использованием константы C5, и сигнала угла курса φ - из приемника CHC:the control coefficient K 5 using the constant C 5 and the heading angle signal φ from the receiver CHC:

K5=C5/cos(270°-φ),K 5 = C 5 / cos (270 ° -φ),

который подают в блок коррекции законов управления, где формируют сигнал коррекции оборотов Δnзд гребного вала:which is fed to correction unit control laws, wherein the correction signal is formed of revolutions Δn rear propeller shaft:

Δnзд=K5(γ-γзд),Δn rear = K 5 (γ-γ rear ),

который подают на вход канала регулирования оборотов n гребного вал, формируя закон управления приводом гребного вала: nзд=Δnзд+K1(V-Vзд)+f(n,V);which is fed to the input of the speed control channel n of the propeller shaft, forming the control law of the propeller shaft drive: n health = Δn health + K 1 (VV health ) + f (n, V);

коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника CHC:control coefficient K 3 using constant C 3 and a course angle signal φ from the receiver CHC:

K3=C3/cos(270°-φ),K 3 = C 3 / cos (270 ° -φ),

который вводят в блоке коррекции законов управления, где формируют nподр. зд : which is entered in the block of correction of control laws, where n sub. rear:

nподр.зд.=-K3(Ф-Фзд),n undercarriage = -K 3 (f- f rear ),

который подают на вход канала регулирования оборотов nподр подруливающего устройства;which is fed to the input of the speed control channel n consecutive steering device;

коэффициент регулирования K4 с использованием константы C4 и сигнала угла курса φ - из приемника CHC:control coefficient K 4 using constant C 4 and the signal of the course angle φ - from the receiver CHC:

K4=C4/cos(270°-φ),K 4 = C 4 / cos (270 ° -φ),

который подают в блок коррекции законов управления, где формируют сигнал управления углом Δδкорр рулевого привода:which is fed to the correction block of control laws, where they form the control signal for the angle Δδ corr of the steering gear:

Δδкорр=-K4(Ф-Фзд),Δδ corr = -K 4 (f- f rear ),

который подают на вход канала регулирования угла δ рулевого привода δ, а сигналы K1(ПУ-φзд)+K2ω, подаваемые на вход канала регулирования угла δ рулевого привода из приемника CHC и задатчика маршрута, отключают;which is fed to the input of the channel for adjusting the angle δ of the steering drive δ, and the signals K 1 (PU-φ rear ) + K 2 ω supplied to the input of the channel for adjusting the angle δ of the steering drive from the receiver CHC and the route setter are turned off;

коэффициент регулирования K5 использованием константы C5, и сигнала угла курса φ из приемника CHC:control factor K 5 using the constant C 5 and the heading angle signal φ from the receiver CHC:

K5=C5/cos(270°-φ),K 5 = C 5 / cos (270 ° -φ),

который подают в блок коррекции законов управления, где формируют сигнал коррекции оборотов Δnзд гребного вала:which is fed to correction unit control laws, wherein the correction signal is formed of revolutions Δn rear propeller shaft:

Δnзд=K5(γ-γзд),Δn rear = K 5 (γ-γ rear ),

который подают на вход канала регулирования оборотов n гребного вала, где формируют закон управления приводом гребного вала:which is fed to the input of the speed control channel n of the propeller shaft, where the control law of the propeller shaft drive is formed:

nзд=Δnзд+K1(V-Vзд)+f(n,V);n zd = Δn zd + K 1 (VV zd ) + f (n, V);

коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника CHC:control coefficient K 3 using constant C 3 and a course angle signal φ from the receiver CHC:

K3=C3/cos(270°-φ),K 3 = C 3 / cos (270 ° -φ),

который подают в блоке коррекции законов управления, где формируют nподр. зд формируют сигнал:which is served in the block correction of control laws, where they form n sub. rear form a signal:

nподр.зд.=-K3(Ф-Фзд),n undercarriage = -K 3 (f- f rear ),

который подают на вход канала регулирования оборотов nподр, подруливающего устройства, через интервал времени Δt в блоке сравнения формируют модуль разности сигнала |ПУ-φзд| и сравнивают с постоянной C, и если удовлетворяется условие |ПУ-φзд|≤C, то через следующие интервалы времени Δt в блоке сравнения повторяют операцию сравнения до тех пор, пока удовлетворяется условие |ПУ-φзд|≤C; если в момент времени mΔt указанное условие |ПУ-φзд|≤C продолжает удовлетворяться, то повторяют цикл корректировки коэффициентов законов управления указанных параметров; если удовлетворяется неравенство |ПУ-φзд|>C, то цикл корректировки законов управления указанными параметрами прекращается и осуществляют типовое управлении указанными параметрами.which is fed to the input of the speed control channel n sub , thruster, through the time interval Δt in the comparison unit form the signal difference module | PU-φ health | and compared with a constant C, and if the condition is satisfied | zd PU-φ | ≤C, then in the next time interval Δt in comparison block comparison operation is repeated until the condition is met | zd PU-φ | ≤C; if at the time the condition is mΔt | PU-φ bldg | ≤C still satisfied, then repeat the cycle correction coefficients of these parameters control laws; if the inequality | PU- φw |> C is satisfied, then the cycle of adjusting the laws of control of the specified parameters is terminated and typical control of the specified parameters is carried out.

На чертеже представлена блок-схема системы автоматического управления движением судна по расписанию.The drawing shows a block diagram of a system for automatically controlling the movement of a ship according to a schedule.

Система автоматического управления судном по расписанию содержит приемник 1 спутниковой навигационной системы (CHC) с выходами сигнала путевого угла (ПУ), текущей скорости V судна, выходом текущих широты и долготы и выходом сигнала угла курса φ, задатчик 2 маршрута с выходами заданного ПУ и заданного φзд угла курса, регулятор 3 угла δзд перекладки руля, рулевой привод 4, регулятор 5 оборотов nзд гребного вала, привод 6 гребного вала, регулятор 7 оборотов nподр подруливающего устройства, подруливающее устройство 8, блок 9 сравнения, блок 10 разностей, блок 11 коррекции законов управления угла δ перекладки руля, оборотов n гребного вала, оборотов nподр подруливающего устройства, блок 12 четырех секторов граничных значений углов положения вектора ПУ, формирователь 13 коэффициентов законов управления и судно 14 - объект управления.The scheduled ship’s automatic control system contains a satellite navigation system (CHC) receiver 1 with outputs of the track angle (CI) signal, current vessel speed V, current latitude and longitude output and heading angle signal φ, route preset 2 with outputs of the given control and set zd heading angle φ, the angle knob 3, δ zd rudder steering actuator 4, the controller 5 turns n zd propeller shaft, the propeller drive shaft 6, the controller 7 turns n consecutive thruster thruster unit 8, a comparing unit 9, the control unit 10 to the differences second, unit 11 the control laws of correction of the angle δ rudder propeller shaft revolutions n, n consecutive rotations of the steering device, the block 12 four sectors of the boundary values of angles vector position PU, the coefficients generator 13 the control laws and the vessel 14 - the control object.

Выход сигнала ПУ приемника CHC подключен к входу канала регулирования угла δзд перекладки руля, образованному регулятором 3 угла δзд и рулевым приводом 4, а выход скорости V судна приемника 1 CHC - к первому входу канала регулирования оборотов nзд гребного вала, образованного регулятором 5 оборотов гребного вала и приводом 6 гребного вала. Выход ПУ приемника 1 CHC и выход заданного угла φзд курса задатчика 2 маршрута подключены к входам блока 9 сравнения, формирующего модуль разности |ПУ-φзд| на выходе, который соединен с первым входом блока 10 разностей. Второй вход блока 10 разностей подключен к выходу формирования текущей широты Ф или долготы γ судна приемника CHC, а третий - к выходу заданного угла φзд курса задатчика 2 маршрута, соединенному со вторым входом канала регулирования оборотов nзд гребного вала и первым входом блока 11 коррекции законов управления угла δ перекладки руля, оборотов n гребного вала, оборотов nподр подруливающего устройства. Второй, третий, четвертый и пятый входы указанного блока 11 коррекции соединены с выходами блока 10 разности, формирователя 13 коэффициентов законов управления, блока 12 четырех секторов граничных значений углов положения вектора ПУ и четвертым выходом сигнала угла φ курса приемника 1 CHC. Выход указанного блока 11 подключен к третьим входам каналов регулирования угла δ перекладки руля, канала регулирования оборотов nз гребного вала и входу канала регулирования оборотов nподр, подруливающего устройства 8. Четвертый выход приемника 1 CHC соединен с первым входом формирователя 13 коэффициентов управления, второй вход которого подключен ко второму выходу блока 10 разности, а третий - к входу блока 12 четырех секторов, который формирует зоны четырех граничных значений ПУ:The signal output of the PU of the receiver CHC is connected to the input of the channel for controlling the angle δ rear of the rudder, formed by the angle controller 3 of δ rear and the steering gear 4, and the output of the speed V of the vessel of the receiver 1 CHC is connected to the first input of the channel for controlling the speed n of the rear shaft formed by the regulator 5 speed of the propeller shaft and drive 6 of the propeller shaft. Yield CHC UE receiver 1 and the output angle φ predetermined rate setpoint bld route 2 are connected to inputs of the comparator unit 9, forming the modulus of the difference | zd PU-φ | at the output, which is connected to the first input of the block 10 differences. The second input unit 10 differences connected to the output of forming the current latitude F or longitude CHC receiver γ vessel, and the third - to the output of the predetermined angle φ zd rate setpoint 2 route connected to the second input channel adjustment revolutions n zd propeller shaft and the first input 11, the correction unit laws steering angle δ rudder propeller shaft revolutions n, n consecutive rotations of the steering device. The second, third, fourth and fifth inputs of the indicated correction block 11 are connected to the outputs of the difference block 10, the shaper 13 of the coefficients of the control laws, the block 12 of the four sectors of the boundary values of the angles of the position of the vector PU and the fourth signal output of the angle φ of the receiver 1 CHC. Output of said block 11 is connected to the third input channel adjustment angle δ rudder speed control channel n of the propeller shaft and the entry channel n consecutive speed control, the steering device 8. The fourth output of receiver 1 CHC is connected to the first input driver 13 of the control coefficients, a second input which is connected to the second output of the difference block 10, and the third to the input of the block 12 of four sectors, which forms the zone of the four boundary values of PU:

«а)» (-π/4)=+7π/4 < угол вектора ПУ < +π/4, или“A)” (-π / 4) = + 7π / 4 <angle of the vector of the PN <+ π / 4, or

«б)» +π/4 < угол вектора ПУ < +3π/4, или“B)” + π / 4 <angle of the vector of the control vector <+ 3π / 4, or

«в)» +3π/4 < угол вектора ПУ < +5π/4, или“C)” + 3π / 4 <angle of the PN vector <+ 5π / 4, or

«г)» +5π/4 < угол вектора ПУ < +7π/4=(-π/4)."D)" + 5π / 4 <angle of the vector of the PN <+ 7π / 4 = (- π / 4).

Способ управления в системе автоматического управления движением судна по расписанию осуществляется следующим образом.The control method in the system of automatic control of the movement of the vessel according to the schedule is as follows.

Типовое управление по путевому углу ПУ=φзд формируется во 2ой подсистеме управления кормовым рулевым приводом. Для этого в регулятор 3 рулевого привода 4 вводят сигналы:Typical control along the track angle PU = φ rear is formed in the 2nd subsystem for controlling the stern steering drive. To do this, in the controller 3 of the steering gear 4 enter the signals:

ПУ - текущего путевого угла из приемника 1 (CHC),PU - the current track angle from the receiver 1 (CHC),

φзд - заданного (программного) угла курса из задатчика 2 маршрута,φ rear - a given (software) course angle from route setter 2,

ω - угловой скорости судна, которая формируется в регуляторе 3 рулевого привода.ω is the angular velocity of the vessel, which is formed in the controller 3 of the steering gear.

Закон управления углом д перекладки руля имеет вид:The law of controlling the angle d of the rudder shift is:

δ з д . = K 1 ( П У ϕ з д ) + K 2 ω ,                      ( 1 )

Figure 00000007
δ s d . = K one ( P At - ϕ s d ) + K 2 ω , ( one )
Figure 00000007

где δзд - заданный угол перекладки руля,where δ rear - a given rudder angle,

φзд(t) - заданный (программный) угол курса,φ rear (t) is the given (program) angle of the course,

K1,K2 - коэффициенты регулирования;K 1, K 2 - regulation factors;

Сигнал δзд по зависимости (1) с выхода регулятора 3 рулевого привода вводят на вход рулевого привода 4, что обеспечивает вывод судна на путевой угол ПУ, равный заданному (программному) углу курса φзд.The signal δ rear according to (1) from the output of the controller 3 of the steering gear is input to the input of the steering gear 4, which ensures the output of the vessel to the steering angle PU equal to the specified (program) course angle φ rear .

Для типового управление канала управления оборотами n гребного вала (скоростью хода судна - V=Vзд) на ее вход вводят сигналы: заданной скорости хода Vзд. из задатчика 2 маршрута и текущей скорости хода V из приемника 1 CHC. Эти сигналы вводят на вход регулятора 5 оборотов и гребного вала для формирования закона управления оборотами гребного вала:For a typical control channel control the speed n of the propeller shaft (ship speed - V = V rear ) to its input signals: the specified speed V rear. from the master 2 routes and the current speed V from the receiver 1 CHC. These signals are input to the input of the regulator 5 revolutions and the propeller shaft to form the law of control of the revolutions of the propeller shaft:

n з д . = K 1 ( V 1 V з д ) . + f ( n , V ) ,,                      ( 2 )

Figure 00000008
n s d . = K one ( V one - V s d ) . + f ( n , V ) ,, ( 2 )
Figure 00000008

где nзд - заданные обороты гребного вала n,where n rear - the specified speed of the propeller shaft n,

f(n,V) - типовой закон регулирования оборотов n гребного вала.f (n, V) is a typical law for regulating the revolutions of n propeller shaft.

Если |ПУ-φзд|≤C1, то осуществляется формирование точного закона управления следующим образом.If | PU-φ zd | ≤C 1 , then the exact control law is formed as follows.

Переход со штатного (типового) управления с использованием текущего и заданного путевого угла ПУ и заданной скорости хода судна на более точное управление с использованием текущих и заданных широт и долгот, производится только при выполнении условия: модуль от разности путевого угла и заданного значения угла курса не превышает допустимую величину:The transition from the standard (typical) control using the current and predetermined path angle of the launcher and the predetermined speed of the ship to more accurate control using the current and preset latitudes and longitudes is carried out only if the condition is met: the module does not differ from the difference between the direction angle and the set value of the course angle exceeds the permissible value:

|ПУ-φзд|≤C1. | PU-φ bldg | ≤C 1.

При выполнении этого условия подключается канал регулирования углом оборотов nподр подруливающего устройства 8; осуществляется перестройка законов управления (1) и канала регулирования углом перекладки руля и оборотами гребного вала закон управления строится с использованием текущих и заданных широт и долгот.Under this condition, connects the angle adjusting channel n consecutive rotations of the steering device 8; adjustment of the control laws (1) and the control channel by the rudder angle and the speed of the propeller shaft is carried out, the control law is built using the current and specified latitudes and longitudes.

Сигнал ПУ из приемника 1 CHC и сигнал заданного φзд угла курса из задатчика 2 маршрута вводят на вход блока 9 сравнения, в котором формируют модуль разности сигналов |ПУ-φзд|.The signal receiver of the UE 1 and the signal CHC predetermined angle φ zd rate setpoint of route 2 is introduced to the input of the comparator unit 9, wherein the modulus of the difference signals is formed | zd PU-φ |.

Если |ПУ-φзд|>C, что соответствует использованию типового режима управления, то сигналы ПУ и φзд отключают от входа блока 9 сравнения, а через интервал времени Δt сигналы ПУ и φзд вновь вводят в блок 9 сравнения, формируя модуль разности сигналов |ПУ-φзд|, и сравнивают с постоянной С. Если |ПУ-φзд|>C, то вновь через интервалы времени Δt в блоке 9 сравнения повторяют операции сравнения этих сигналов, при этом функционирует штатное управление движением судна.If | PU-φ zd |> C, which corresponds to the use of a typical control mode, then the signals of PU and φ zd are disconnected from the input of the comparison unit 9, and after a time interval Δt the signals PU and φ zd are again input into the comparison unit 9, forming the difference module signals | PU-φ zd |, and compare with constant C. If | PU-φ zd |> C, then again, at time intervals Δt in block 9 of the comparison, the operations of comparing these signals are repeated, while the regular control of the vessel’s movement is functioning.

Если в блоке 9 сравнения удовлетворяется условие |ПУ-φзд|≤C, то формируют точный закона управления следующим образом.If, in block 9 comparison with | PU-φ bldg | ≤C, the exact form of the control law as follows.

В блоке 10 разностей формируют сигналы разности текущей широты Ф или долготы γ судна из приемника 1 CHC и заданной широты Фзд, или заданной долготы γзд из задатчика 2 маршрута: (Ф-Фзд) или (γ-γзд), которые вводят в блок 11 коррекции законов управления угла δ перекладки руля, оборотов n гребного вала, оборотов nподр подруливающего устройства.In the block of 10 differences, signals of the difference of the current latitude Φ or longitude γ of the vessel from the receiver 1 CHC and the specified latitude Φ rear , or the given longitude γ rear from the destination unit 2 of the route: (F-F rear ) or (γ-γ rear ) are generated , which are input in block 11 the control laws of correction of the angle δ rudder propeller shaft revolutions n, n consecutive rotations of the steering device.

В блоке 12 четырех секторов граничных значений углов положения вектора ПУ формируют сигнал одного из четырех секторов, в котором находится в данный момент вектор ПУ, используя сигнал путевого угла из приемника 1 CHC и сигналы заданных углов соответствующих граничных значений одного из четырех секторов:In block 12 of the four sectors of the boundary values of the angles of position of the vector of the PU, a signal of one of the four sectors in which the vector of the PU is located at the moment is used, using the path angle signal from the receiver 1 CHC and the signals of the given angles of the corresponding boundary values of one of the four sectors:

«а).» (-π/4)=+7π/4 < угол вектора ПУ < +π/4, или“A).” (-Π / 4) = + 7π / 4 <angle of the vector of the PN <+ π / 4, or

«б)» +π/4 < угол вектора ПУ < +3π/4, или“B)” + π / 4 <angle of the vector of the control vector <+ 3π / 4, or

«в)» +3π/4 < угол вектора ПУ < +5π/4, или“C)” + 3π / 4 <angle of the PN vector <+ 5π / 4, or

«г)» +5π/4 < угол вектора ПУ < +7π/4=(-π/4)."D)" + 5π / 4 <angle of the vector of the PN <+ 7π / 4 = (- π / 4).

Сигнал одного из указанных четырех секторов, в котором находится в данный момент вектор ПУ вводят в блок 11 коррекции законов управления для формирования сигналов управления в этом блоке, куда уже введены сигналы разности: (Ф-Фзд) или (γ-γзд).The signal of one of these four sectors, in which the PU vector is currently located, is input into the block 11 of the correction of control laws to generate control signals in this block, where the difference signals are already entered: (f- f w ) or (γ-g w ).

В формирователе 13 коэффициентов законов управления формируют коэффициенты регулирования, которые вводят в блок 11 коррекции законов управления, в котором формируют сигналы законов управления:In the shaper 13 of the coefficients of control laws form the regulation coefficients, which are entered into the block 11 of the correction of control laws, in which the signals of the control laws are generated:

коррекция Δδкор для канала управления углом перекладки руля кормового рулевого привода 4 с отключением закона управления (1);correction Δδ cor for the control channel of the rudder angle of the aft steering gear 4 with the control law turned off (1);

коррекции оборотов Δnзд гребного вала для канала управления оборотами гребного вала;correction of revolutions Δn of the rear propeller shaft for the control channel of the revolutions of the propeller shaft;

коррекция заданных оборотов nподр для регулятора 7 подруливающего устройства 8.correction of the set revolutions n sub for controller 7 of the thruster 8.

При наличии сигнала нахождения ПУ в секторе «а)» из блока 12 четырех секторов формируют:In the presence of a signal of PU location in sector “a)” from block 12 of four sectors form:

коэффициенты регулирования K1 и K 1 . 1

Figure 00000001
в формирователе 13 коэффициентов законов управления с использованием констант C1, C 1 1
Figure 00000009
и сигнала курса φ из приемника 1 CHC:control factors K 1 and K one . one
Figure 00000001
in the shaper 13 coefficients of control laws using constants C 1 , C one one
Figure 00000009
and course signal φ from receiver 1 CHC:

K1=C1/cos(φ),K 1 = C 1 / cos (φ),

K 1 1 = C 1 1 /cos ( ϕ )

Figure 00000003
. K one one = C one one / cos ( ϕ )
Figure 00000003
.

Сигналы коэффициентов K1 и K 1 . 1

Figure 00000001
регулирования вводят в блок 11 коррекции законов управления, где формируют сигнал управления углом δ перекладки руля:Signals of the coefficients K 1 and K one . one
Figure 00000001
the regulation is introduced into the block 11 correction of control laws, where they form the control signal of the angle δ of the rudder shift:

δ к о р р . = K 1 ( γ γ з д ) + K 1 1 d ( γ γ з д ) / d t .                      ( 1 a )

Figure 00000010
. δ to about R R . = K one ( γ - γ s d ) + K one one d ( γ - γ s d ) / d t . ( one a )
Figure 00000010
.

Сигнал Δδкорр вводят на вход регулятора 3 рулевого привода 4, а сигналы. K1(ПУ-φзд)+K2ω, подключенные к входу регулятора 3 рулевого привода 4 из приемника 1 CHC и задатчика 2 маршрута отключают, т.е. отключают типовой режим управления по закону (1);The signal Δδ corr enter the input of the controller 3 of the steering gear 4, and the signals. K 1 (PU-φ rear ) + K 2 ω connected to the input of the regulator 3 of the steering gear 4 from the receiver 1 of the CHC and the setpoint 2 of the route are disconnected, i.e. disable the typical control mode according to the law (1);

коэффициент регулирования K2 с использованием константы C2 и сигнала угла φ курса из приемника 1 CHC:regulation coefficient K 2 using constant C 2 and the signal of the angle φ of the course from the receiver 1 CHC:

K2=C2/cos(φ),K 2 = C 2 / cos (φ),

который вводят в блок 11 коррекции законов управления для формирования сигнала коррекции оборотов Δnзд гребного вала:which is introduced into the control laws of correction block 11 for generating Δn rear propeller shaft rotational speed correction signal:

Δnзд=-К2(Ф-Фзд),Δn rear = -K 2 (f-F rear ),

который вводят на вход регулятора 5 оборотов n гребного вала для формирования коррекции закона управления оборотами nзд гребного вала:which is introduced to the input of regulator 5 revolutions n of the propeller shaft to form a correction control law revolutions n zd propeller shaft:

n зд . = Δ n з д + K 1 (V-V зд ) . + f(n ,V) ,                                       (2a)

Figure 00000011
. n healthy . = Δ n s d + K one (VV healthy ) . + f (n , V) , (2a)
Figure 00000011
.

который подают на вход привода 6 оборотов гребного вала;which is fed to the input of the drive 6 revolutions of the propeller shaft;

коэффициент регулирования K3 с использованием константы C3 и сигнала угла φ курса из приемника 1 CHC:regulation coefficient K 3 using constant C 3 and a signal of the angle φ of the course from the receiver 1 CHC:

K3=C3/cos(φ).K 3 = C 3 / cos (φ).

В блоке 11 коррекции законов управления формируют сигнал заданных оборотов nпод зд подруливающего устройства:In block 11 of the correction of control laws form a signal of the given speed n under the rear of the thruster:

n подр .зд . = -K 3 ( γ - γ зд ) ,                                                        (3a)

Figure 00000012
n sub .zd . = -K 3 ( γ - γ healthy ) , (3a)
Figure 00000012

который вводят на вход регулятора 7 оборотов nподр, подруливающего устройства 8, сигнал с выхода которого вводят в подруливающее устройство.which is introduced to the input of the controller 7 revolutions n sub , thruster 8, the output signal of which is introduced into the thruster.

При наличии сигнала о нахождения ПУ в секторе «в)» из блока 12 четырех секторов граничных значений углов положения вектора ПУ формируют коэффициенты регулирования K1 и K 1 . 1

Figure 00000001
в формирователе 13 коэффициентов законов управления с использованием констант C1, C 1 1
Figure 00000009
и сигнала угла φ курса из приемника 1 CHC:If there is a signal about the location of PU in sector “c)” from block 12 of four sectors of the boundary values of the angles of position of the vector of the PU, the control coefficients K 1 and K one . one
Figure 00000001
in the shaper 13 coefficients of control laws using constants C 1 , C one one
Figure 00000009
and the angle signal φ of the course from the receiver 1 CHC:

K1=C1/cos(180°-φ),K 1 = C 1 / cos (180 ° -φ),

K 1 1 = C 1 1 / c o s ( 1 8 0 o - ϕ )

Figure 00000005
, K one one = C one one / c o s ( one 8 0 o - ϕ )
Figure 00000005
,

которые вводят в блок 11 коррекции законов управления, где формируют закон управления рулевьм приводом 4:which are introduced into the block 11 of the correction of control laws, where they form the law of steering the steering drive 4:

Δ δ к о р р . = K 1 ( γ γ з д ) K 1 1 d ( γ γ з д ) / d t .                     ( 1 б )

Figure 00000013
. Δ δ to about R R . = - K one ( γ - γ s d ) - K one one d ( γ - γ s d ) / d t . ( one b )
Figure 00000013
.

Сигналы K1(ПУ-φзд)+K2ω, подключенные к входу регулятора 3 угла δ перекладки рулевого привода 4 из приемника 1 CHC и задатчика 2 маршрута, отключают, т.е отключают типовой режим управления по закону (1)). Сигнал Δδкорр вводят на вход регулятора 3 рулевого привода 4;The signals K 1 (PU-φ rear ) + K 2 ω connected to the input of the controller 3 of the angle δ of the shift of the steering gear 4 from the receiver 1 of the CHC and the setter 2 of the route are disabled, i.e., they deactivate the typical control mode according to the law (1)). The signal Δδ corr is input to the input of the controller 3 of the steering gear 4;

коэффициент регулирования K2 с использованием константы C2 и сигнала угла φ курса из приемника 1 CHC:regulation coefficient K 2 using constant C 2 and the signal of the angle φ of the course from the receiver 1 CHC:

K2=C2/cos(180°-φ),K 2 = C 2 / cos (180 ° -φ),

который вводят в блок 11 коррекции сигналов управления для формирования сигнала коррекции оборотов Δnзд гребного вала:which is introduced into the block 11 correction of control signals to generate a signal for correction of revolutions Δn of the rear shaft:

Δnзд=K2(Ф-Фзд),Δn rear = K 2 (f-F rear ),

который вводят на вход регулятора 5 оборотов n гребного вала для формирования закона управления оборотами n гребного вала:which is introduced to the input of the controller 5 revolutions n of the propeller shaft to form the law of controlling the revolutions of n propeller shaft:

n зд . = Δ n з д + K 1 (V-V зд ) . + f(n ,V); .                                        ( )

Figure 00000014
n healthy . = Δ n s d + K one (VV healthy ) . + f (n , V); . ( 2b )
Figure 00000014

Коэффициент регулирования K3 с использованием константы C3 и сигнала угла φ курса из приемника 1 CHC:The regulation coefficient K 3 using the constant C 3 and the signal of the angle φ of the course from the receiver 1 CHC:

K3=C3/cos(180°-φ).K 3 = C 3 / cos (180 ° -φ).

В блоке 11 коррекции законов управления формируют сигнал заданных оборотов nпод зд подруливающего устройства 8:In block 11 of the correction of control laws form a signal of the given speed n under the rear of the thruster 8:

n подр .зд . = K 3 ( γ - γ зд ) ,                                                         ( )

Figure 00000015
n sub .zd . = K 3 ( γ - γ healthy ) , ( 3b )
Figure 00000015

который вводят на вход регулятора 7 оборотов подруливающего устройства 8, с выхода которого сигнал nподр вводят в подруливающее устройство 8.which is introduced to the input of the governor 7 revolutions of the thruster 8, from the output of which the signal n sub is introduced into the thruster 8.

При наличии сигнала о нахождения ПУ в секторе «б)» из блока 12 четырех секторов в формирователе 13 коэффициентов законов управления формируют:If there is a signal about the location of PU in sector "b)" from block 12 of four sectors in the shaper 13 coefficients of control laws form:

коэффициент регулирования K4 с использованием констант C4 и сигнала угла φ курса из приемника 1 CHC:regulation coefficient K 4 using the constants C 4 and the signal of the angle φ of the course from the receiver 1 CHC:

K4=C4/cos(90°-φ),K 4 = C 4 / cos (90 ° -φ),

который вводят в блок 11 коррекции законов управления, где формируют сигнал управления рулевым приводом 4:which is introduced into the block 11 correction of control laws, where they form the control signal of the steering gear 4:

Δ δ к о р р . = K 4 ( Ф Ф з д ) ,                                               ( 1 в )

Figure 00000016
Δ δ to about R R . = - K four ( F - F s d ) , ( one at )
Figure 00000016

который вводят на вход регулятора 3 рулевого привода 4. Сигналы K1(ПУ-φзд)+K2ω, подключенные к входу регулятора 3 рулевого привода 4 из приемника 1 CHC и задатчика 2 маршрута, отключают, то есть отключают типовой режима управления по закону (1);which is input to the input of the controller 3 of the steering gear 4. The signals K 1 (PU-φ rear ) + K 2 ω connected to the input of the controller 3 of the steering gear 4 from the receiver 1 CHC and the setpoint 2 of the route are disabled, that is, they deactivate the typical control mode by law (1);

коэффициент регулирования K5 с использованием константы C5 и сигнала угла φ курса из приемника 1 CHC:control coefficient K 5 using the constant C 5 and the signal of the angle φ of the course from the receiver 1 CHC:

K5=C5/cos(90°-φ),K 5 = C 5 / cos (90 ° -φ),

который вводят в блок 11 коррекции законов управления для формирования сигнала коррекции оборотов Δnзд гребного вала:which is introduced into the control laws of correction block 11 for generating Δn rear propeller shaft rotational speed correction signal:

Δnзд=-K5(γ-γзд),Δn rear = -K 5 (γ-γ rear ),

который вводят на вход регулятора 5 оборотов n гребного вала и формируют закон управления:which is introduced to the input of the regulator 5 revolutions n of the propeller shaft and form the control law:

n зд . = Δ n з д + K 1 (V-V зд ) . + f(n ,V);                                        ( )

Figure 00000017
n healthy . = Δ n s d + K one (VV healthy ) . + f (n , V); ( 2c )
Figure 00000017

коэффициент регулирования K3 с использованием константы C3 и сигнала угла φ курса из приемника 1 CHC:regulation coefficient K 3 using constant C 3 and a signal of the angle φ of the course from the receiver 1 CHC:

K3=C3/cos(90°-φ).K 3 = C 3 / cos (90 ° -φ).

В блоке 11 коррекции законов управления формируют сигнал заданных оборотов nпод зд подруливающего устройства 8:In block 11 of the correction of control laws form a signal of the given speed n under the rear of the thruster 8:

n п о д р . з д . = K 3 ( Ф - Ф з д ) , ( 3 в )

Figure 00000018
n P about d R . s d . = K 3 ( F - F s d ) , ( 3 at )
Figure 00000018

который вводят на вход регулятора 7 оборотов подруливающего устройства 8. Сигнал nподр с выхода регулятора 7 оборотов вводят в подруливающее устройство 8.which is introduced to the input of the controller 7 revolutions of the thruster 8. The signal n sub from the output of the regulator 7 revolutions is input to the thruster 8.

При наличии сигнала о нахождении ПУ в секторе «г)» из блока 12 четырех секторов в формирователе 13 коэффициентов законов управления, формируют:If there is a signal about the location of PU in sector “g)” from block 12 of four sectors in the shaper 13 coefficients of control laws, form:

коэффициент регулирования K4 с использованием константы C4 и сигнала угла φ курса из приемника 1 CHC:regulation coefficient K 4 using constant C 4 and a signal of the angle φ of the course from the receiver 1 CHC:

K4=C4/cos(270°-φ), который вводят в блок 11 коррекции законов управления для формирования сигнала управления рулевым приводом 4:K 4 = C 4 / cos (270 ° -φ), which is introduced into the block 11 correction of the laws of control to generate a control signal for the steering gear 4:

Δ δ к о р р . = K 4 ( Ф Ф з д ) , ( 1 г )

Figure 00000019
Δ δ to about R R . = - K four ( F - F s d ) , ( one g )
Figure 00000019

который вводят на вход регулятора 3 рулевого привода 4. Сигналы K1(ПУ-φзд)+K2ω, подключенные к входу регулятора 3 рулевого привода 4 из приемника 1 CHC и задатчика 2 маршрута, отключают, то есть отключают типовой режима управления по закону (1);which is input to the input of the controller 3 of the steering gear 4. The signals K 1 (PU-φ rear ) + K 2 ω connected to the input of the controller 3 of the steering gear 4 from the receiver 1 CHC and the setpoint 2 of the route are disabled, that is, they deactivate the typical control mode by law (1);

коэффициент регулирования K5 с использованием константы C5, и сигнала угла φ курса из приемника 1 CHC:the control coefficient K 5 using the constant C 5 , and the signal of the angle φ of the course from the receiver 1 CHC:

K5=C5/cos(270°-φ),K 5 = C 5 / cos (270 ° -φ),

который вводят в блок 11 коррекции законов управления, для формирования сигнала коррекции оборотов Δnзд гребного вала:which is introduced into the block 11 of the correction of control laws, for the formation of the correction signal of the revolutions Δn rear row shaft:

Δnзд=K5(γ-γзд),Δn rear = K 5 (γ-γ rear ),

который вводят на вход регулятора 5 оборотов n гребного вала и формируют закон управления:which is introduced to the input of the regulator 5 revolutions n of the propeller shaft and form the control law:

n зд . = Δ n з д + K 1 (V-V зд ) . + f(n ,V .;                                        ( )

Figure 00000020
n healthy . = Δ n s d + K one (VV healthy ) . + f (n , V .; ( 2g )
Figure 00000020

коэффициент регулирования K3 с использованием константы C3 и сигнала угла φ курса из приемника 1 CHC:regulation coefficient K 3 using constant C 3 and a signal of the angle φ of the course from the receiver 1 CHC:

K3=C3/cos(270°-φ).K 3 = C 3 / cos (270 ° -φ).

В блоке 11 коррекции законов управления формируют сигнал заданных оборотов nпод зд подруливающего устройства 8:In block 11 of the correction of control laws form a signal of the given speed n under the rear of the thruster 8:

n п о д р . з д . = K 3 ( Ф - Ф з д ) , ( 3 г )

Figure 00000021
n P about d R . s d . = - K 3 ( F - F s d ) , ( 3 g )
Figure 00000021

который вводят на вход регулятора 7 оборотов подруливающего устройства 8, с выхода которого сигнал оборотов nподр. зд вводят в подруливающее устройство 8.which is introduced to the input of the controller 7 revolutions of the thruster 8, from the output of which the signal of revolutions n sub . rear introduced into the thruster 8.

Таким образом, осуществляется формирование и включение в работу режима точного управления судном с использованием рулевого привода 4 привода 6 оборотов гребного вала и подруливающих устройств 8.Thus, the formation and inclusion in the mode of precise control of the vessel using the steering gear 4 of the drive 6 revolutions of the propeller shaft and thrusters 8 is carried out.

Через интервалы времени Δt контролируется нахождение судна в допустимой области использования точного управления, а через интервал времени mΔt повторяется цикл настройки закона точного управления с использованием текущих и заданных данных по широте и долготе. В случае перехода на новое направление движения судна. При выполнении условия |ПУ-φзд|>C1 отключается точное управление и включается штатное управление, которое затем перестраивается на точное управление, если выполняется условие |ПУ-φзд|≤C.At time intervals Δt, the vessel is located in the permissible area of use of precise control, and after a time interval mΔt, the cycle of setting the law of precise control is repeated using the current and specified data in latitude and longitude. In case of transition to a new direction of movement of the vessel. When the condition | PU-φ zd |> C 1 is fulfilled, the exact control is turned off and the regular control is turned on, which is then tuned to the exact control if the condition | PU-φ zd | ≤C is fulfilled.

Реализация системы автоматического управления судном по расписанию может быть осуществлена с помощью контроллера или с использованием микросхем типа 140 УД 6 и 140 УД-8.Implementation of a system of automatic control of a ship on a schedule can be carried out using a controller or using microcircuits of type 140 UD 6 and 140 UD-8.

Система автоматически обеспечивает движение корабля по заданной траектории в двух режимах как при штатном (типовом) режиме управления, так и при точном управлении с использованием информации о широтах и долготах.The system automatically ensures the movement of the ship along a predetermined trajectory in two modes both in the standard (typical) control mode and in precise control using information about latitudes and longitudes.

Моделирование рассмотренного выше способа автоматического управления движением судна, подтвердило его работоспособность и высокую эффективность использования предложенного способа управления движением судна по расписанию.Simulation of the above method for automatic control of the movement of the vessel, confirmed its efficiency and high efficiency of the proposed method of controlling the movement of the vessel on a schedule.

Claims (2)

1. Устройство для управления судном по расписанию, содержащее канал регулирования угла δ перекладки руля судна, канал регулирования оборотов n гребного вала судна, приемник спутниковой навигационной системы, выход сигнала путевого угла (ПУ) которого подключен к первому входу канала регулирования угла δ перекладки руля, а выход скорости V судна указанного приемника - к первому входу канала регулирования оборотов nзд гребного вала, задатчик маршрута, выход заданного угла φзд курса которого подключен ко второму входу канала регулирования угла перекладки руля, а выход заданной скорости Vзд задатчика маршрута судна - ко второму входу канала регулирования оборотов nзд гребного вала, отличающееся тем, что введены подруливающее устройство судна, регулятор оборотов nподр подруливающего устройства судна, образующих канал регулирования оборотов nподр подруливающего устройства, формирователь коэффициентов законов управления, блок четырех секторов граничных значений углов положения вектора путевого угла (ПУ):
«а)» (-π/4)=+7π/4 < угол вектора путевого угла (ПУ) <+π/4, или
«б)» +π/4 < угол вектора путевого угла (ПУ) <+3π/4, или
«в)» +3π/4 < угол вектора путевого угла (ПУ) <+5π/4, или
«г)» +5π/4 < угол вектора путевого угла (ПУ) <+7π/4=(-π/4),
блок сравнения, блок разностей и блок коррекции законов управления угла δ перекладки руля, оборотов nзд гребного вала, оборотов nподр подруливающего устройства, выход путевого угла (ПУ) приемника спутниковой навигационной системы и выход заданного угла φзд курса задатчика маршрута подключены к входам блока сравнения, выполненного с возможностью формирования модуля разности |ПУ-φзд| на выходе, который соединен с первым входом блока разностей, второй вход которого подключен к выходу текущей широты Ф и текущей долготы γ приемника спутниковой навигационной системы, а третий вход - к выходу заданного угла φзд курса задатчика маршрута, соединенному с первым входом блока коррекции сигналов законов управления указанных каналов регулирования, второй, третий, четвертый и пятый входы которого соединены соответственно с выходом блока разностей, с выходом формирователя коэффициентов законов управления, с выходом указанного блока четырех секторов, с выходом сигнала угла φ курса приемника спутниковой навигационной системы, соединенным с первым входом формирователя коэффициентов законов регулирования и входом блока четырех секторов, второй вход формирователя коэффициентов законов управления подключен ко второму выходу блока разности, а выход указанного блока коррекции - к третьим входам канала регулирования угла δ перекладки руля и канала регулирования оборотов nзд гребного вала и входу канала регулирования оборотов nподр подруливающего устройства судна.
1. A device for controlling a ship according to a schedule, comprising a channel for controlling the angle δ of the rudder of the vessel, a channel for controlling the speed n of the propeller shaft of the satellite navigation system, the output of the signal of the track angle (PU) of which is connected to the first input of the channel for regulating the angle of δ of the rudder, and the output speed of said V receiver vessel - to the first input channel adjustment revolutions n zd propeller shaft, the route setting unit, the output angle φ zd predetermined rate of which is connected to the second input channel adjustment yz la rudder, and output a predetermined velocity V zd setpoint vessel route - to the second input channel adjustment revolutions n zd propeller shaft, characterized in that the introduced thruster vessel device, n consecutive speed control thruster vessel device forming channel regulation of revolutions n consecutive thruster , shaper of the coefficients of control laws, block of four sectors of boundary values of the angles of the position of the track angle vector (PU):
“A)” (-π / 4) = + 7π / 4 <the angle of the path angle vector (PU) <+ π / 4, or
"B)" + π / 4 <the angle of the path angle vector (PU) <+ 3π / 4, or
“C)” + 3π / 4 <the angle of the path angle vector (PU) <+ 5π / 4, or
"D)" + 5π / 4 <the angle of the path angle vector (PU) <+ 7π / 4 = (- π / 4),
a comparison unit block differences and the correction unit laws steering angle δ rudder revolutions n zd propeller shaft revolutions n consecutive thruster exit track angle (PU) satellite navigation system receiver, and output the predetermined angle φ zd rate set point of the route connected to the inputs of block comparison, made with the possibility of forming the difference module | PU-φ health | at the output, which is connected to the first input of the difference block, the second input of which is connected to the output of the current latitude Φ and the current longitude γ of the receiver of the satellite navigation system, and the third input is to the output of the given angle φ h of the course setter connected to the first input of the signal correction block control laws of the indicated control channels, the second, third, fourth and fifth inputs of which are connected respectively to the output of the difference block, with the output of the shaper of the coefficients of the control laws, with the output of the specified the eye of four sectors, with the output of the angle signal φ of the receiver of the satellite navigation system connected to the first input of the generator of coefficients of regulation laws and the input of the block of four sectors, the second input of the generator of coefficients of control laws is connected to the second output of the difference block, and the output of the specified correction block to the third input channel adjustment angle δ rudder and the channel regulation of revolutions n of the shaft and the rear propeller speed control entry channel n consecutive vessel the steering device.
2. Способ автоматического управления движением судна по расписанию, в котором сигналы путевого угла (ПУ) и скорости хода судна V из приемника спутниковой навигационной системы вводят на вход канала регулирования угла δ рулевого привода и на вход канала регулирования оборотов nзд привода гребного вала соответственно, сигналы заданного угла φзд курса и заданной скорости Vзд хода судна из задатчика маршрута подают в канал регулирования угла δ рулевого привода и в канал регулирования оборотов nзд привода гребного вала соответственно, в которых формируют законы типового управления указанными параметрами, отличающийся тем, что сигнал путевого угла (ПУ) из приемника спутниковой навигационной системы и сигнал заданного угла φзд курса из задатчика маршрута сравнивают в блоке сравнения, на выходе которого формируют модуль разности сигналов |ПУ-φзд|, который сравнивают с постоянной C, если выполняется условие |ПУ-φзд|>C, то через интервал времени Δt повторяют операцию сравнения сигнала модуля |ПУ-φзд| с постоянной C до тех пор, пока указанное условие |ПУ-φзд|>С выполняется; если выполняется условие |ПУ-φзд|≤C, осуществляют корректировку сформированных ранее законов управления угла δ рулевого привода и оборотов n привода гребного вала, для этого в блоке разностей формируют сигналы разности текущей широты Ф и заданной широты Фзд судна из задатчика маршрута и текущей долготы γ и заданной долготы γзд судна из задатчика маршрута, которые подают в блок коррекции законов управления; в блоке четырех секторов граничных значений вектора путевого угла (ПУ) формируют зоны четырех секторов граничных значений вектора путевого угла (ПУ):
«а)» (-π/4)=+7π/4 < угол вектора путевого угла (ПУ) <+π/4, или
«б)» +π/4 < угол вектора путевого угла (ПУ) <+3π/4, или
«в)» +3π/4 < угол вектора путевого угла (ПУ) <+5π/4, или
«г)» +5π/4 < угол вектора путевого угла (ПУ) <+7π/4=(-π/4),
определяют, в каком из указанных секторов находится в данный момент времени вектор путевого угла (ПУ), и подают граничные значения путевого угла (ПУ) соответствующего выявленного сектора в формирователь коэффициентов законов управления и блок коррекции законов управления угла δ перекладки руля, оборотов nзд гребного вала, оборотов nподр подруливающего устройства, при этом:
если вектор путевого угла (ПУ) находится в зоне а), то в формирователе коэффициентов регулирования формируют:
коэффициенты K1 и K 1 1
Figure 00000022
c использованием констант C1, С 1 1
Figure 00000023
и сигнала угла курса φ из приемника спутниковой навигационной системы:
K1=C1/cos(φ),
K 1 1 = C 1 1 /cos ( φ )
Figure 00000024
,
которые подают в блок коррекции сигналов законов управления, где формируют сигнал коррекции закона управления угла δ рулевого привода:
Δ δ к о р р = K 1 ( γ - γ з д ) + K 1 1 d ( γ - γ з д ) / d t
Figure 00000025
,
который подают в канал регулирования угла δ рулевого привода, а сигналы
K1(ПУ-φзд)+K2ω из приемника спутниковой навигационной системы и задатчика маршрута отключают от канала регулирования угла δ рулевого привода;
коэффициент регулирования K2 с использованием константы C2 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K2=C2/cos(φ),
который подают в блок коррекции законов управления для формирования сигнала коррекции закона управления оборотами гребного вала Δnзд:
Δnзд=-K2(Ф-Фзд),
который подают в канал регулирования оборотов n гребного вала:
nзд=Δnзд+K1(V-Vзд)+f(n,V);
коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K3=C3/cos(φ),
в блоке коррекции законов управления формируют сигнал заданных оборотов nподр.зд подруливающего устройства:
nподр.зд=-K3(γ-γзд),
который подают на вход канала регулирования оборотов nподр подруливающего устройства;
если вектор путевого угла (ПУ) находится в зоне сектора б), то в формирователе коэффициентов законов управления формируют:
коэффициенты регулирования K1 и K 1 1
Figure 00000026
c использованием констант C1, C 1 1
Figure 00000002
и сигнала угла курса φ из приемника спутниковой навигационной системы:
K1=C1/cos(180°-φ),
K 1 1 = C 1 1 / c o s ( 1 8 0 o - φ )
Figure 00000027
,
которые подают в блок коррекции законов управления, где формируют закон управления рулевым приводом:
Δ δ к о р р = - K 1 ( γ - γ з д ) - K 1 1 d ( γ - γ з д ) / d t
Figure 00000028
,
который подают в канал регулирования угла δ рулевого привода, а сигналы
K1(ПУ-φзд)+K2ω из приемника спутниковой навигационной системы и задатчика маршрута отключают от канала регулирования угла δ рулевого привода;
коэффициент регулирования K2 с использованием константы C2 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K2=C2/cos(180°-φ),
который подают в блок коррекции законов управления для формирования сигнала коррекции закона управления оборотами Δnзд гребного вала nподр:
Δnзд=K2(Ф-Фзд),
который подают на вход канала регулирования оборотами n гребного вала, где формируют сигнал задания оборотов nзд гребного вала:
nзд=Δnзд+K1(V-Vзд)+f(n,V);
коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K3=C3/cos(180°-φ),
который подают в блок коррекции законов управления, где формируют сигнал заданных оборотов nподр.зд подруливающего устройства:
nподр.зд =K3(γ-γзд),
который подают в канал регулирования оборотов nподр подруливающего устройства;
если вектор путевого угла (ПУ) находится в секторе в), то в формирователе коэффициентов законов управления формируют:
коэффициент регулирования K4 с использованием константы C4 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K4=C4/cos(90°-φ),
который подают в блок коррекции законов управления, где формируют сигнал управления рулевым приводом Δδкорр:
Δδкорр=-K4(Ф-Фзд),
который подают на вход канала регулирования угла δ рулевого привода, а сигналы K1(ПУ-φзд)+K2ω, подаваемые на вход канала регулирования угла δ рулевого привода из приемника спутниковой навигационной системы и задатчика маршрута, отключают;
коэффициент регулирования K5 с использованием константы C5 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K5=C5/cos(90°-φ),
который подают в блок коррекции законов управления для формирования сигнала коррекции оборотов Δnзд гребного вала:
Δnзд=-K5(γ-γзд),
который подают на вход канала регулирования оборотов n гребного вала, где формируют закон управления:
nзд=Δnзд+K1(V-Vзд)+f(n,V);
коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K3=C3/cos(90°-φ),
который подают в блок коррекции сигналов управления, где формируют сигнал скорости nподр. зд подруливающего устройства:
nподр.зд=K3(Ф-Фзд),
который подают на вход канала регулирования оборотов nподр подруливающего устройства, который подают в подруливающее устройство;
если вектор путевого угла (ПУ) находится в зоне сектора г), то в формирователе коэффициентов законов управления формируют:
коэффициент регулирования K4 с использованием константы C4 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K4=C4/cos(270°-φ),
который подают в блок коррекции законов управления, где формируют сигнал управления рулевым приводом Δδкорр:
Δδкорр=-K4(Ф-Фзд),
который подают на вход канала регулирования угла δ рулевого привода, а сигналы K1(ПУ-φзд)+K2ω, подаваемые на вход канала регулирования угла δ рулевого привода из приемника спутниковой навигационной системы и задатчика маршрута, отключают;
коэффициент регулирования K5 с использованием константы C5 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K5=C5/cos(270°-φ),
который подают в блок коррекции законов управления, где формируют сигнал коррекции оборотов Δnзд гребного вала:
Δnзд=K5(γ-γзд),
который подают на вход канала регулирования оборотов n гребного вала, формируя закон управления приводом гребного вала: nзд=Δnзд+K1(V-Vзд)+f(n,V);
коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K3=C3/cos(270°-φ),
который подают в блок коррекции законов управления, где формируют nподр.зд:
nподр.зд=-K3(Ф-Фзд),
который подают на вход канала регулирования оборотов nподр подруливающего устройства;
коэффициент регулирования K4 с использованием константы C4 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K4=C4/cos(270°-φ),
который подают в блок коррекции законов управления, где формируют сигнал управления углом Δδкорр рулевого привода:
Δδкорр=-K4(Ф-Фзд),
который подают на вход канала регулирования угла δ рулевого привода δ, а сигналы K1(ПУ-φзд)+K2ω, подаваемые на вход канала регулирования угла δ рулевого привода из приемника спутниковой навигационной системы и задатчика маршрута, отключают;
коэффициент регулирования K5 с использованием константы C5 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K5=C5/cos(270°-φ),
который подают в блок коррекции законов управления, где формируют сигнал коррекции оборотов Δnзд гребного вала:
Δnзд=K5(γ-γзд),
который подают на вход канала регулирования оборотов n гребного вала, где формируют закон управления приводом гребного вала:
nзд=Δnзд+K1(V-Vзд)+f(n,V);
коэффициент регулирования K3 с использованием константы C3 и сигнала угла курса φ из приемника спутниковой навигационной системы:
K3=C3/cos(270°-φ),
который подают в блок коррекции законов управления, где формируют nподр.зд сигнал:
nподр.зд=-K3(Ф-Фзд),
который подают на вход канала регулирования оборотов nподр подруливающего устройства, через интервал времени Δt в блоке сравнения формируют модуль разности сигнала |ПУ-φзд| и сравнивают с постоянной C, и если удовлетворяется условие |ПУ-φзд|≤C, то через следующие интервалы времени Δt в блоке сравнения повторяют операцию сравнения до тех пор, пока удовлетворяется условие |ПУ-φзд|≤C, если в момент времени mΔt указанное условие |ПУ-φзд|≤C продолжает удовлетворяться, то повторяют цикл корректировки коэффициентов регулирования законов управления указанных параметров; если удовлетворяется неравенство |ПУ-φзд|>C, то цикл корректировки законов управления указанными параметрами прекращают и осуществляют типовое управление указанными параметрами.
2. A method of automatically controlling the movement of a ship according to a schedule in which the signals of the track angle (C) and ship speed V from the receiver of the satellite navigation system are input to the input of the angle control channel δ of the steering gear and to the input of the speed control channel n rear of the propeller shaft, respectively, signals of a predetermined angle φ zd rate and a given speed V zd vessel travel route from the set point is fed in the control channel of the angle δ of the steering actuator and speed control channel n zd propeller drive shaft respectively, a koto ryh form a model control laws specified parameters, characterized in that the signal track angle (PU) from the satellite navigation system receiver, and the signal given angle φ zd course of the setpoint path is compared in a comparison unit, whose output forms the signal difference module | PU-φ zd |, which is compared with the constant C, if the condition | PU-φ health |> C is fulfilled, then after the time interval Δt the operation of comparing the signal of the module | PU-φ health | with constant C until the indicated condition | PU- φw |> C is satisfied; if the condition | zd PU-φ | ≤C, formed previously performed adjustment of the steering control laws and drive δ n revolutions of the propeller drive shaft, this difference in block form the difference signals, and current latitude F F zd predetermined breadth of the vessel from the set point and the route the current longitude γ and the given longitude γ of the ship rear from the route master, which are fed to the control law correction block; in the block of four sectors of the boundary values of the path angle vector (PU) form the zone of four sectors of the boundary values of the path angle vector (PU):
“A)” (-π / 4) = + 7π / 4 <the angle of the path angle vector (PU) <+ π / 4, or
"B)" + π / 4 <the angle of the path angle vector (PU) <+ 3π / 4, or
“C)” + 3π / 4 <the angle of the path angle vector (PU) <+ 5π / 4, or
"D)" + 5π / 4 <the angle of the path angle vector (PU) <+ 7π / 4 = (- π / 4),
determining which of said sectors are at a given time the vector track angle (PU), and fed boundary value track angle (PU) of the respective identified sector generator control laws coefficients and correction unit angle δ rudder control laws of revolutions n zd propeller shaft revolutions n consecutive steering device, wherein:
if the path angle vector (PU) is in zone a), then in the shaper of the regulation coefficients form:
coefficients K 1 and K one one
Figure 00000022
using constants C 1 , FROM one one
Figure 00000023
and the angle signal φ from the receiver of the satellite navigation system:
K 1 = C 1 / cos (φ),
K one one = C one one / cos ( φ )
Figure 00000024
,
which are fed to the correction block of the laws of control laws, where they form the correction signal of the control law of the angle δ of the steering gear:
Δ δ to about R R = K one ( γ - γ s d ) + K one one d ( γ - γ s d ) / d t
Figure 00000025
,
which is fed into the steering angle control channel δ of the steering gear, and the signals
K 1 (PU-φ rear ) + K 2 ω from the receiver of the satellite navigation system and the route setter are disconnected from the channel for adjusting the angle δ of the steering drive;
regulation coefficient K 2 using constant C 2 and the signal of the course angle φ from the receiver of the satellite navigation system:
K 2 = C 2 / cos (φ),
which is fed to the correction block of the control laws for generating a correction signal of the control law of the propeller shaft speed Δn rear :
Δn rear = -K 2 (f-F rear ),
which is fed into the speed control channel n of the propeller shaft:
n zd = Δn zd + K 1 (VV zd ) + f (n, V);
regulation coefficient K 3 using constant C 3 and a signal of the course angle φ from the receiver of the satellite navigation system:
K 3 = C 3 / cos (φ),
in the block of correction of control laws form a signal of the given revolutions n subdrive of the thruster:
n subdrive = -K 3 (γ-γ rear ),
which is fed to the input of the speed control channel n consecutive steering device;
if the direction angle vector (PU) is in the area of sector b), then in the shaper of the coefficients of control laws form:
control factors K 1 and K one one
Figure 00000026
using constants C 1 , C one one
Figure 00000002
and the angle signal φ from the receiver of the satellite navigation system:
K 1 = C 1 / cos (180 ° -φ),
K one one = C one one / c o s ( one 8 0 o - φ )
Figure 00000027
,
which are fed to the block of correction of control laws, where they form the law of steering control:
Δ δ to about R R = - K one ( γ - γ s d ) - K one one d ( γ - γ s d ) / d t
Figure 00000028
,
which is fed into the steering angle control channel δ of the steering gear, and the signals
K 1 (PU-φ rear ) + K 2 ω from the receiver of the satellite navigation system and the route setter are disconnected from the channel for adjusting the angle δ of the steering drive;
regulation coefficient K 2 using constant C 2 and the signal of the course angle φ from the receiver of the satellite navigation system:
K 2 = C 2 / cos (180 ° -φ),
which is fed to the correction block of the control laws for generating a correction signal of the speed control law Δn of the rear shaft of the propeller n ex :
Δn rear = K 2 (f-F rear ),
which is fed to the input channel adjustment revolutions n of the propeller shaft, wherein the reference signal is formed of revolutions n of the propeller shaft zd:
n zd = Δn zd + K 1 (VV zd ) + f (n, V);
regulation coefficient K 3 using constant C 3 and a signal of the course angle φ from the receiver of the satellite navigation system:
K 3 = C 3 / cos (180 ° -φ),
which is fed to the correction block of the control laws, where they form the signal of the given revolutions n underrun of the thruster:
n subdrive = K 3 (γ-γ rear ),
which is fed to the speed control channel n consecutive steering device;
if the direction angle vector (PU) is in sector c), then in the shaper of the coefficients of control laws form:
regulation coefficient K 4 using constant C 4 and a signal of the course angle φ from the receiver of the satellite navigation system:
K 4 = C 4 / cos (90 ° -φ),
which is fed to the correction block of the control laws, where they form the steering signal control Δδ corr :
Δδ corr = -K 4 (f- f rear ),
which is fed to the input of the channel for adjusting the angle δ of the steering drive, and the signals K 1 (PU-φ rear ) + K 2 ω supplied to the input of the channel for adjusting the angle δ of the steering drive from the receiver of the satellite navigation system and the route setter are turned off;
regulation coefficient K 5 using constant C 5 and the signal of the course angle φ from the receiver of the satellite navigation system:
K 5 = C 5 / cos (90 ° -φ),
which is fed to the correction block of the control laws for generating a signal for the correction of revolutions Δn of the rear shaft:
Δn rear = -K 5 (γ-γ rear ),
which is fed to the input of the speed control channel n of the propeller shaft, where the control law is formed:
n zd = Δn zd + K 1 (VV zd ) + f (n, V);
regulation coefficient K 3 using constant C 3 and a signal of the course angle φ from the receiver of the satellite navigation system:
K 3 = C 3 / cos (90 ° -φ),
which is fed to the control signal correction block, where a speed signal n sub is generated . rear thruster:
n subdrive = K 3 (F-F rear ),
which is fed to the input of the speed control channel n sub thruster, which is fed to the thruster;
if the direction angle vector (PU) is in the sector of sector d), then in the shaper of the coefficients of control laws form:
regulation coefficient K 4 using constant C 4 and a signal of the course angle φ from the receiver of the satellite navigation system:
K 4 = C 4 / cos (270 ° -φ),
which is fed to the correction block of the control laws, where they form the steering signal control Δδ corr :
Δδ corr = -K 4 (f- f rear ),
which is fed to the input of the channel for adjusting the angle δ of the steering drive, and the signals K 1 (PU-φ rear ) + K 2 ω supplied to the input of the channel for adjusting the angle δ of the steering drive from the receiver of the satellite navigation system and the route setter are turned off;
regulation coefficient K 5 using constant C 5 and the signal of the course angle φ from the receiver of the satellite navigation system:
K 5 = C 5 / cos (270 ° -φ),
which is fed to correction unit control laws, wherein the correction signal is formed of revolutions Δn rear propeller shaft:
Δn rear = K 5 (γ-γ rear ),
which is fed to the input of the speed control channel n of the propeller shaft, forming the control law of the propeller shaft drive: n health = Δn health + K 1 (VV health ) + f (n, V);
regulation coefficient K 3 using constant C 3 and a signal of the course angle φ from the receiver of the satellite navigation system:
K 3 = C 3 / cos (270 ° -φ),
which is served in the block correction of control laws, where they form n sub.zd :
n subdrive = -K 3 (F-F rear ),
which is fed to the input of the speed control channel n consecutive steering device;
regulation coefficient K 4 using constant C 4 and a signal of the course angle φ from the receiver of the satellite navigation system:
K 4 = C 4 / cos (270 ° -φ),
which is fed to the correction block of control laws, where they form the control signal for the angle Δδ corr of the steering gear:
Δδ corr = -K 4 (f- f rear ),
which is fed to the input of the channel for adjusting the angle δ of the steering drive δ, and the signals K 1 (PU-φ rear ) + K 2 ω supplied to the input of the channel for adjusting the angle δ of the steering drive from the receiver of the satellite navigation system and route setter are turned off;
regulation coefficient K 5 using constant C 5 and the signal of the course angle φ from the receiver of the satellite navigation system:
K 5 = C 5 / cos (270 ° -φ),
which is fed to correction unit control laws, wherein the correction signal is formed of revolutions Δn rear propeller shaft:
Δn rear = K 5 (γ-γ rear ),
which is fed to the input of the speed control channel n of the propeller shaft, where the control law of the propeller shaft drive is formed:
n zd = Δn zd + K 1 (VV zd ) + f (n, V);
regulation coefficient K 3 using constant C 3 and a signal of the course angle φ from the receiver of the satellite navigation system:
K 3 = C 3 / cos (270 ° -φ),
which is fed into the block of correction of control laws, where they form n sub-bits of the signal:
n subdrive = -K 3 (F-F rear ),
which is fed to the input channel adjustment revolutions n consecutive steering device, after a time interval Δt in comparison block form a modulus of the difference signal | zd PU-φ | and compared to the C constant, and if the condition is satisfied | PU-φ bldg | ≤C, then in the next time interval Δt in the comparator comparison operation is repeated as long as the condition is satisfied | PU-φ bldg | ≤C, if at the moment mΔt time specified condition | PU-φ bldg | ≤C still satisfied, then repeat the cycle correction coefficient control laws regulating the above parameters; if the inequality | PU-φ zd |> C is satisfied, then the cycle of adjusting the laws of control of the indicated parameters is stopped and typical control of the indicated parameters is carried out.
RU2013105883/11A 2013-02-13 2013-02-13 Device and method for automatic control of scheduled vessel movement RU2525606C1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
RU2013105883/11A RU2525606C1 (en) 2013-02-13 2013-02-13 Device and method for automatic control of scheduled vessel movement

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
RU2013105883/11A RU2525606C1 (en) 2013-02-13 2013-02-13 Device and method for automatic control of scheduled vessel movement

Publications (2)

Publication Number Publication Date
RU2525606C1 true RU2525606C1 (en) 2014-08-20
RU2013105883A RU2013105883A (en) 2014-08-20

Family

ID=51384186

Family Applications (1)

Application Number Title Priority Date Filing Date
RU2013105883/11A RU2525606C1 (en) 2013-02-13 2013-02-13 Device and method for automatic control of scheduled vessel movement

Country Status (1)

Country Link
RU (1) RU2525606C1 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB1408636A (en) * 1971-09-21 1975-10-01 France Armed Forces Control devices
US5152239A (en) * 1991-11-19 1992-10-06 Raytheon Company Autopilot having roll compensation capabilities
RU2292289C1 (en) * 2005-07-20 2007-01-27 Институт проблем управления им. В.А. Трапезникова РАН Method of automatic control of ship motion
RU2465169C1 (en) * 2011-04-21 2012-10-27 Учреждение Российской академии наук Институт проблем управления им. В.А. Трапезникова РАН Method for vessel course following control

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB1408636A (en) * 1971-09-21 1975-10-01 France Armed Forces Control devices
US5152239A (en) * 1991-11-19 1992-10-06 Raytheon Company Autopilot having roll compensation capabilities
RU2292289C1 (en) * 2005-07-20 2007-01-27 Институт проблем управления им. В.А. Трапезникова РАН Method of automatic control of ship motion
RU2465169C1 (en) * 2011-04-21 2012-10-27 Учреждение Российской академии наук Институт проблем управления им. В.А. Трапезникова РАН Method for vessel course following control

Also Published As

Publication number Publication date
RU2013105883A (en) 2014-08-20

Similar Documents

Publication Publication Date Title
CN107153420B (en) Path tracking control method and device and intelligent automobile
EP1365301B1 (en) Method and system for maneuvering a movable object
US10000270B2 (en) Moving body control device, moving body control method, and moving body control program
US11220290B2 (en) Traveling control apparatus of vehicle
RU2292289C1 (en) Method of automatic control of ship motion
US8086362B2 (en) Method and device for aiding the piloting of an aircraft
EP3132244B1 (en) Path control system
JP2009248897A (en) Automatic ship steering device
JP7106872B2 (en) AUTOMATIC DRIVING CONTROL DEVICE AND AUTOMATIC DRIVING CONTROL METHOD FOR VEHICLE
US20230211786A1 (en) Path-controlling module, associated path-controlling device and associated method
CN107757620A (en) Method and apparatus for running automation motor vehicle
CN105843224A (en) AUV horizontal planar path tracking control method based on neural dynamic model and backstepping method
CN110770119B (en) Method for determining a speed profile of a ship
RU2759068C1 (en) Method for automatic pilotage of ship
RU2525606C1 (en) Device and method for automatic control of scheduled vessel movement
RU2330789C1 (en) Ship mooring method
Kiselev et al. Selected Features of Autonomous Underwater Robot Dynamics under Near-Bottom Equidistant Motion Control
RU2491509C1 (en) Apparatus for forming path for switching ship to new heading
RU2516885C2 (en) Method of controlling ship movement on latitude and longitude
RU2465169C1 (en) Method for vessel course following control
RU2452655C1 (en) Method of ship automatic control
US8606440B2 (en) Method for determining correction under steering of a point on a towed object towards a goal position
Nieuwenhuizen et al. Evaluation of haptic shared control and a highway-in-the-sky display for personal aerial vehicles
RU171461U1 (en) System of automatic control of ship movement in direction and speed
RU2350506C1 (en) Method of ship mooring

Legal Events

Date Code Title Description
MM4A The patent is invalid due to non-payment of fees

Effective date: 20200214