RU2301174C1 - Система автоматического управления движением судна - Google Patents
Система автоматического управления движением судна Download PDFInfo
- Publication number
- RU2301174C1 RU2301174C1 RU2005135181/11A RU2005135181A RU2301174C1 RU 2301174 C1 RU2301174 C1 RU 2301174C1 RU 2005135181/11 A RU2005135181/11 A RU 2005135181/11A RU 2005135181 A RU2005135181 A RU 2005135181A RU 2301174 C1 RU2301174 C1 RU 2301174C1
- Authority
- RU
- Russia
- Prior art keywords
- output
- input
- vessel
- adder
- control
- Prior art date
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Изобретение относится к области судовождения, в частности к управлению движением кораблей и морских судов. Система содержит датчик (1) и задатчик (2) путевого угла, датчик угловой скорости (3) и датчик угла (4) перекладки руля, выходы которых подключены к входам сумматора-усилителя (5), выход которого соединен со входом рулевого привода (6). Система дополнена блоком с зоной нечувствительности (8), первым и вторым диодами, первым и вторым электромагнитными реле, первым (13) и вторым (14) блоками уставок. Выходы датчика путевого угла и задатчика путевого угла подключены к входам блока с зоной нечувствительности, выход которого через первый диод соединен с обмоткой управления первого реле, нормально разомкнутая контактная группа которого соединяет вход сумматора-усилителя с выходом первого блока уставки. Вход сумматора-усилителя через нормально разомкнутую контактную группу второго реле соединен с выходом второго блока уставки, а вход обмотки управления второго реле через второй диод соединен с выходом блока с зоной нечувствительности. Изобретение обеспечивает эффективную работу системы управления во всем диапазоне изменения углов курса (путевых углов). 1 ил.
Description
Изобретение относится к области судостроения и предназначено для управления движением корабля. Известна система управления движением корабля в пространстве («Результаты создания и испытаний системы управления движением скоростного катера типа «Мираж». Сборник трудов XXXI Всероссийской конференции «Управление движением морскими судами и специальными аппаратами». Изд. ИПУ РАН. Москва, 2004), в которой для автоматического управления движением судна используют приемник СНС в качестве датчика текущего путевого угла в диапазоне 0-360° и задатчик путевого угла, работающий также в диапазоне 0-360°. При формировании закона автоматического управления движением судна вблизи 360-0° наблюдаются сбои в автоматическом управлении.
Известна также система автоматического управления движением корабля, принятая нами в качестве прототипа (патент России №2248914), содержащая датчик и задатчик курса, датчик угловой скорости, датчик положения руля, выходы которых подсоединены к входам сумматора-усилителя, выход которого соединен со входом рулевого привода. При использовании датчиков угла курса (путевого угла) и задатчика курса, работающих в диапазоне 0-360°, возникает сбой автоматического управления движением судна (при переходе судна, а следовательно, и датчика угла курса с 360° к углам, близким к нулевым значениям (при этом задатчик угла курса остается в области, близкой к 360°).
Задачей предлагаемого изобретения является создание системы управления движением судна, лишенного отмеченного выше недостатка, с обеспечением эффективной (без сбоев) работы системы во всем диапазоне изменения углов курса (путевых углов).
Рассмотрим причину появления сбоев в автоматической системе стабилизации заданного путевого угла с типовым законом управления движением судна (патент России №2248914):
где d/dt δзд - заданная скорость перекладки руля,
ΔПУ=(ПУ-ПУзд) - сигнал рассогласования по путевому углу,
Ω - сигнал угловой скорости судна,
δ - угол перекладки руля,
K1, К2, K3 - коэффициенты регулирования.
Пусть судно автоматически движется в области малых путевых углов ПУзд=3°, при этом от внешнего возмущения судно перешло через ПУ=0° и вошло в область больших значения путевого угла (ПУ вблизи 360°), тогда, в соответствии с зависимостью (1), на вход рулевого привода поступит сигнал d/dt δзд положительного знака. Руль переложится также в положительном направлении, что приведет к дальнейшему увеличению ухода судна относительно заданного направления ПУзд=3°. Для устранения произошедшего сбоя необходимо вернуть судно на ПУ=ПУзд=3° вручную. Существенно отметить, что до перехода судна через ПУ=360° с ПУ=3° при уменьшении значения путевого угла, ПУ=2°..., 1°, сигнал d/dt δзд, в соответствии зависимостью (1), был отрицательного знака, т.е. при рыскании судна в сторону уменьшения текущего путевого угла в соответствии с зависимостью (1) отрицательный знак сигнала d/dt δзд приводит к отклонению руля в отрицательном направлении, противодействуя тем самым отклонению судна от возмущающего воздействия и стремясь возвратить судно к заданному значению путевого угла, но при переходе судна через нулевое значение ПУ в область больших значений «2π» ПУ (вследствие действия возмущения) знак сигнал d/dt δзд в зависимости (1) изменится на обратный, и руль начинает отклоняться в положительном (обратном) направлении, и угол рассогласования по путевому углу начнет увеличиваться.
Устранить сбой в работе системы можно, если в зависимость (1) в момент перехода путевого угла из области малых значений в диапазон значений путевого угла, близких «+2π», ввести уставку «-2π»:
В этом случае знак сигнала d/dt δзд не изменится при переходе судна через ПУ=0° в область ПУ, близких к «+2π», и останется отрицательным, заставляя тем самым судно вернуться к заданным малым значениям путевого угла. При обратном переходе судном нулевого значения путевого угла уставку -2π необходимо исключить из закона управления, т.е. заменить зависимость (1а) зависимостью (1).
При использовании закона управления (1) сбой может произойти также при движении судна с тем же путевым углом ПУ=3° при полном штиле, но если судоводитель начал вводить новое значение путевого угла, ПУзд, близкое к области 2π, для устранения такого сбоя вместо закона управления (1) следует ввести уставку «+2π» в зависимость (1):
Аналогично при стабилизации движения судна на путевых углах, близких к 2π, при отклонении судна или задатчика путевого угла через нулевое значение путевого угла в область малых путевых углов происходит сбой в системе управления, для устранения происходящих при этом сбоев системы автоматического управления необходимо в закон управления (1) вводить описанные выше уставки.
Для достижения поставленной цели (исключения сбоев в системе при движении судна с путевым углом вблизи нулевых или вблизи значений 2π) известная система управления движением судна дополняется блоком с зоной нечувствительности, двумя диодами, двумя электромагнитными реле и двумя блоками уставок.
Заявляемая система управления движением судна, содержащая датчик и задатчик путевого угла, датчик угловой скорости и датчик угла перекладки руля, выходы которых подключены соответственно к первому-четвертому входам сумматора-усилителя, выход которого соединен с входом рулевого привода, дополнена блоком с зоной нечувствительности, первым и вторым диодами, двумя электромагнитными реле и двумя блоками уставок. Выходы датчика путевого угла и задатчика путевого угла подключены к входам блока с зоной нечувствительности, выход которого через первый диод соединен с обмоткой управления первого электромагнитного реле, а также через второй диод соединен с обмоткой управления второго электромагнитного реле, нормально разомкнутый контакт которого соединяет шестой вход сумматора-усилителя с выходом второго блока уставки. Пятый вход сумматора-усилителя через нормально разомкнутую контактную группу первого электромагнитного реле соединен с выходом первого блока уставки.
На чертеже приведена функциональная схема системы управления движением судна, содержащая датчик и задатчик путевого угла 1, 2, датчик угловой скорости 3, датчик угла перекладки руля 4, сумматор-усилитель 5, рулевой привод 6, судно 7, блок с зоной нечувствительности 8, первый и второй диоды 9, 10, первое и второе электромагнитное реле 11, 12, первый и второй блоки уставок 13, 14.
При реализации системы управления движением судна в качестве датчика путевого угла 1 может использоваться приемник спутниковой навигационной системы, в качестве задатчика путевого угла 2 может использоваться типовой преобразователь «вал-цифра» с индикатором, датчик угловой скорости 3 судна должен обладать чувствительностью не хуже 0,03°/сек, датчик угла перекладки руля 4 - цифровой преобразователь «вал-цифра» с чувствительностью не ниже 0,5°, сумматор-усилитель 5 (при реализации в аналоговом варианте) - это может быть микросхема типа 140 УД-6, специальных требований к судовому рулевому приводу 6 не предъявляется, блок с зоной нечувствительности 8 может быть реализован на микросхеме типа 140 УД 6 с зоной нечувствительности на входе -/+π, к диодам 9, 10 и электромагнитным реле 11, 12 специальных требований нет, блоки уставок 13, 14 - двухполярные источники постоянных напряжений, соответствующие сигналу ПУ=-/+2π.
Описание работы системы управления движением судна.
Система предназначена для автоматического управления движением судна по заданному судоводителем путевому углу ПУзд и для выполнения заданных судоводителем градусных поправок к текущему курсу судна.
Рассмотрим, как осуществляется автоматическая стабилизация путевого угла при движении судна вблизи нулевых (малых) значений ПУзд. Автоматическое удержание судна на заданном путевом угле осуществляется благодаря использованию приведенного выше закона управления рулевым приводом (1), дополненного условием |(ПУ-ПУзд)|<π:
Вырабатываемый датчиком 1 сигнал текущего путевого угла ПУ поступает на первый вход сумматора-усилителя 5, на второй вход которого поступает сигнал заданного значения путевого угла ПУзд, который устанавливает судоводитель задатчиком путевого утла 2, на третий вход поступает сигнал отрицательной обратной связи по углу перекладки руля -δ с датчика 4, при этом на выходе рулевого привода 6 формируется угол перекладки руля:
В зависимости (2) по сравнению с (1) отсутствует член с « Ω» - сигнал угловой скорости судна, который необходим для обеспечения устойчивости замкнутой системы: «судно - система управления движением», но к нашему рассмотрению этот сигнал не имеет никакого значения.
судно двигается по заданному путевому углу.
При (ПУ>ПУзд), δ>0, судно, благодаря положительно отклоненному рулю при этом, начнет угловое движение в отрицательном направлении к заданному ПУзд (к реализации зависимости (3)).
При (ПУ<ПУзд), δ<0, судно, благодаря отрицательно отклоненному рулю, начнет положительное угловое движение к заданному направлению, т.е. к заданному направлению ПУзд (к реализации зависимости (3)).
При использовании закона управления (1) в особых областях, как мы уже отмечали, могут происходить сбои. Рассмотрим, как они исключаются в предложенных нами законах (А), (1а), (1б).
1ый случай - судно движется в области малых путевых углов, например, ПУзд=3° и ПУ=3°, пусть появляется внешнее возмущение, которое отклоняет судно в сторону нулевого путевого угла: ПУ-(ПУзд=3°)<0.
При 3°>ПУ>0 руль отклоняется в отрицательном направлении и противодействует отклонению судна от заданного путевого угла, но если внешнее возмущение сильнее стабилизирующего воздействия руля, то судно проходит ПУ=0° и входит в область «2π» значений ПУ. В этот момент закон (А) отключается, т.к. |(ПУ=360°)-(ПУзд=3°)|>π (не выполняется условие использования закона (А)).
При использовании закона управления (1) это привело бы к перекладке руля в положительном направлении, следовательно, к дальнейшему уходу судна от заданного значения путевого угла. Для исключения такого сбоя в системе управления необходимо перейти с закона управления (1) на закон управления (1а). Осуществляется это благодаря тому, что в момент перехода судна из нулевой области путевых углов в область 2π путевых углов на вход блока 8 с датчика 1 и задатчика 2 поступит суммарный сигнал, превышающий π, поэтому на выходе блока 8 вырабатывается положительное напряжение, которое проходит через первый диод 9 на обмотку управления первого электромагнитного реле 11, контактная группа которого замкнется, и уставка -U1=-2π с первого блока уставки 13 поступит на пятый вход сумматора-усилителя 5, на выходе которого сформируется отрицательный сигнал, что вызовет отклонение руля в отрицательном направлении, а следовательно, произойдет поворот судна в положительном направлении. В момент времени, когда судно достигнет нулевого значения путевого угла, на выходе блока 8 сигнал ступенькой отключится. (Результирующий сигнал на входе блока 8 (ПУ-ПУзд)≪π - величины зоны нечувствительности на входе блока 8, т.к. на выходе датчика путевого угла 1 вместо сигнала ПУ из области 2π окажется сигнал из области, близкой к нулю). Это приведет к отключению первого электромагнитного реле 11 и переходу от закона управления (1а) к закону управления (А).
2ой случай - пусть судно движется в той же области, близкой к нулевому путевому углу ПУ=ПУзд=3°, а судоводитель выполняет градусную поправку ПУзд=357°, т.е. переход судна на 6°. После введения нового значения ПУзд=357° на вход блока с зоной нечувствительности 8 поступит сигнал с датчика 1 ПУ=3° и задатчика 2 -ПУзд=-357°, т.к. суммарный сигнал |-354°|>π, то на выходе блока 8 появится отрицательное напряжение, которое через второй диод 10 поступит на вход управляющей обмотки второго реле 12, контактная группа которого замкнется и соединит выход второго блока уставки 14 U1=+2π с шестым входом сумматора-усилителя. При этом вместо закона управления (1) в системе произойдет изменение на закон управления (1б). Судно начнет переходить с ПУ=3° к ПУзд=357° через нулевое значение ПУ. В момент перехода судна из области нулевых ПУ в область «2π» ПУ произойдет переход закона управления(1б) к виду (А). Зависимость (А) будет сохраняться до тех пор, пока значения ПУ и ПУзд будут одновременно находится либо в нулевой области ПУ, либо в области «2π» ПУ (когда выполняется условие |(ПУ-ПУзд)|<π).
Claims (1)
- Система автоматического управления движением судна, содержащая датчик и задатчик путевого угла, датчик угловой скорости и датчик угла перекладки руля, выходы которых подключены соответственно к первому, второму, третьему и четвертому входам сумматора-усилителя, выход которого соединен со входом рулевого привода, отличающаяся тем, что дополнена блоком с зоной нечувствительности, первым и вторым диодами, первым и вторым электромагнитными реле, первым и вторым блоками уставок, выходы датчика путевого угла и задатчика путевого угла подключены соответственно к первому и второму входам блока с зоной нечувствительности, выход которого через первый диод соединен с обмоткой управления первого реле, нормально-разомкнутая контактная группа которого соединяет пятый вход сумматора-усилителя с выходом первого блока уставки, шестой вход сумматора-усилителя через нормально-разомкнутую контактную группу второго реле соединен с выходом второго блока уставки, а вход обмотки управления второго реле через второй диод соединен с выходом блока с зоной нечувствительности.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2005135181/11A RU2301174C1 (ru) | 2005-11-14 | 2005-11-14 | Система автоматического управления движением судна |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2005135181/11A RU2301174C1 (ru) | 2005-11-14 | 2005-11-14 | Система автоматического управления движением судна |
Publications (1)
Publication Number | Publication Date |
---|---|
RU2301174C1 true RU2301174C1 (ru) | 2007-06-20 |
Family
ID=38314290
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2005135181/11A RU2301174C1 (ru) | 2005-11-14 | 2005-11-14 | Система автоматического управления движением судна |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2301174C1 (ru) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2494006C2 (ru) * | 2011-12-07 | 2013-09-27 | Федеральное государственное унитарное предприятие "Научно-производственное объединение автоматики имени академика Н.А. Семихатова" | Система автоматического управления |
CN105129065A (zh) * | 2015-08-12 | 2015-12-09 | 中电科(宁波)海洋电子研究院有限公司 | 基于电动舵轮的自动舵系统 |
-
2005
- 2005-11-14 RU RU2005135181/11A patent/RU2301174C1/ru not_active IP Right Cessation
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2494006C2 (ru) * | 2011-12-07 | 2013-09-27 | Федеральное государственное унитарное предприятие "Научно-производственное объединение автоматики имени академика Н.А. Семихатова" | Система автоматического управления |
CN105129065A (zh) * | 2015-08-12 | 2015-12-09 | 中电科(宁波)海洋电子研究院有限公司 | 基于电动舵轮的自动舵系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2021230356A1 (ja) | 船舶の自動誘導方法、船舶の自動誘導プログラム、船舶の自動誘導システム、及び船舶 | |
Moe et al. | Set-based Line-of-Sight (LOS) path following with collision avoidance for underactuated unmanned surface vessel | |
CN101833335B (zh) | 小型水面机器人装置及自适应水流优化导航方法 | |
Claus et al. | Analysis and development of a buoyancy-pitch based depth control algorithm for a hybrid underwater glider | |
JP5442071B2 (ja) | 操船制御装置、自動操船制御システム、操船制御方法、及びプログラム | |
Li et al. | Path following of under-actuated ships based on model predictive control with state observer | |
Kurowski et al. | Multi-vehicle guidance, navigation and control towards autonomous ship maneuvering in confined waters | |
JP2022127826A (ja) | 船舶の減揺制御装置および減揺制御方法 | |
Kim et al. | A numerical and experimental study on the obstacle collision avoidance system using a 2D LiDAR sensor for an autonomous surface vehicle | |
JP2022073731A (ja) | 追尾制御装置 | |
RU2301174C1 (ru) | Система автоматического управления движением судна | |
Holvik | Basics of dynamic positioning | |
CN111208824A (zh) | 一种无人艇航行串级控制系统 | |
WO2018123948A1 (ja) | 船舶の自動操縦システム、船舶、及び船舶の自動操縦方法 | |
Sawada et al. | Automatic berthing control under wind disturbances and its implementation in an embedded system | |
Tranzatto et al. | The debut of Aeolus, the autonomous model sailboat of ETH Zurich | |
CN106767796B (zh) | 类渡槽环境中无人船测距单元与惯性测量单元的融合算法 | |
Paez et al. | Implementation of an unmanned surface vehicle for environmental monitoring applications | |
Zhang et al. | Gliding robotic fish and its tail-enabled yaw motion stabilization using sliding mode control | |
Peng et al. | Safety-Certificated Line-of-Sight Guidance of Unmanned Surface Vehicles for Straight-Line Following in a Constrained Water Region Subject to Ocean Currents | |
Källström | Autopilot and track-keeping algorithms for high-speed craft | |
Fyrvik et al. | Hybrid tracking controller for an ASV providing mission support for an AUV | |
JP2009132257A (ja) | 操船制御方法、プログラム及び装置、並びに自動操船制御システム | |
Miotto et al. | UUV on-board path planning in a dynamic environment for the Manta test vehicle | |
JP2021064248A (ja) | 船舶用自動操船装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
MM4A | The patent is invalid due to non-payment of fees |
Effective date: 20151115 |