RU2029346C1 - Устройство управления угловым движением судна - Google Patents
Устройство управления угловым движением судна Download PDFInfo
- Publication number
- RU2029346C1 RU2029346C1 SU5031140A RU2029346C1 RU 2029346 C1 RU2029346 C1 RU 2029346C1 SU 5031140 A SU5031140 A SU 5031140A RU 2029346 C1 RU2029346 C1 RU 2029346C1
- Authority
- RU
- Russia
- Prior art keywords
- input
- output
- integrator
- adder
- multiplication
- Prior art date
Links
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
Изобретение относится к автоматизации управления подвижными объектами, в частности управления движением морских судов. Целью изобретения является повышение надежности функционирования устройства путем снижения уровня шумов в тракте управления рулевым приводом судна. Поставленная задача решается путем введения в устройство блока восстановления угловой скорости, датчика скорости хода и дополнительного сумматора. 1 ил.
Description
Изобретение относится к области автоматического управления подвижными объектами, в частности движением морских судов.
Известно устройство для управления движением судна [1], в котором формируется ПИД-закон управления, сигнал производной получается путем дифференцирования сигнала угла рассогласования по курсу.
Недостатком устройства является сильная зашумленность сигнала угловой скорости судна, что приводит к снижению запаса устойчивости рассматриваемой системы регулирования и слишком большим нагрузкам на рулевой привод при развитом морском волнении.
Устройство [2] отличается от устройства [1] более совершенным переходом с режима маневра на режим стабилизации курса судна, для чего используется блок упрощенной модели судна, с помощью которой удается вырабатывать заданное значение курса, равное будущему "предсказанному" значению по окончании переходного процесса. Устройству [2] присущи недостатки устройства [1].
Известна также система стабилизации курса судна [3], принятая в качестве прототипа, содержащая датчики курса и угла перекладки руля, датчик углового ускорения, выполненный в виде двух разнесенных по судну линейных акселерометров, интеграторов и сумматоров для выработки сигнала угловой скорости судна, и суммирующий усилитель для управления рулевым приводом.
Недостатком системы является корректировка восстановленного сигнала угловой скорости по невязке восстановленного угла рыскания и измеренного приращения угла курса.
Цель изобретения - повышение надежности функционирования устройства путем снижения уровня шумов в тракте управления рулевым приводом.
Для этого в устройство, содержащее датчик перекладки руля и задатчик угловой скорости, выходы которых подключены соответственно к первому и второму входам сумматора-усилителя, выход которого подключен к рулевому приводу, датчик углового ускорения, выход которого подключен к третьему входу сумматора-усилителя и через первый интегратор соединен с четвертым входом сумматора-усилителя, введены первый сумматор, датчик скорости хода и блок восстановления угловой скорости, содержащий второй, третий и четвертый интеграторы, пять множителей и второй сумматор.
Указанные выше отличительные признаки в совокупности обеспечивают появление в заявляемом объекте ряда новых свойств, заключающихся в существенном повышении надежности и качества автоматического управления морским судном. Повышение надежности и качества достигается восстановлением угловой скорости путем интегрирования сигнала углового ускорения и исключения смещения в восстановленном сигнале благодаря введению на вход интегратора невязки восстановленной угловой скорости с блока восстановления и угловой скорости с выхода интегратора.
На чертеже приведена схема предлагаемого устройства управления угловым движением судна.
Устройство содержит датчик 1 углового ускорения, датчик 2 скорости хода, датчик 3 перекладки руля, задатчик 4 угловой скорости, сумматор-усилитель 5, рулевой привод 6, четыре интегратора 7-10, пять блоков 11-15 перемножения, два сумматора 16, 17 и блок 18 восстановления угловой скорости, входы которого соединены с датчиками перекладки руля и скорости хода, а выходы - с входами усилителя-сумматора 5. Датчик 1 углового ускорения подключен через интегратор 7 и сумматор-усилитель 5 к входу регулятора рулевого привода 6. Второй выход блока 18 восстановления угловой скорости через первый сумматор 16 соединен с вторым входом интегратора 7, а второй вход сумматора 17 соединен с выходом интегратора 7.
В процессе движения судна по заданному направлению руль должен находиться в баллансировочном положении. Среднее значение угла перекладки, соответствующее положению, при котором среднее значение внешнего возмущающего момента компенсируется средним управляющим моментом, создаваемым рулем
M= M
M = Kδср
δср= (1)
Среднее значение угла перекладки руля δср вычисляется на интеграторе 8, охваченном слабой отрицательной обработкой связью. На выходе сумматора 17 вырабатывается текущий угол перекладки руля относительно балансировочного положения
δ′=δ-δср (2)
На интеграторах 9 и 10 совместно с блоками 11-15 перемножения формируется оценка угловой скорости судна
= C V + C + C3V2δ′ (на входе интегратора 9);
= C + CV + C6V2δ (на входе интегратора 10), где Ci- постоянные коэффициенты;
δ- угол перекладки руля;
δ′- угол перекладки руля, смещенный на величину δср .
M= M
M = Kδср
δср= (1)
Среднее значение угла перекладки руля δср вычисляется на интеграторе 8, охваченном слабой отрицательной обработкой связью. На выходе сумматора 17 вырабатывается текущий угол перекладки руля относительно балансировочного положения
δ′=δ-δср (2)
На интеграторах 9 и 10 совместно с блоками 11-15 перемножения формируется оценка угловой скорости судна
= C V + C + C3V2δ′ (на входе интегратора 9);
= C + CV + C6V2δ (на входе интегратора 10), где Ci- постоянные коэффициенты;
δ- угол перекладки руля;
δ′- угол перекладки руля, смещенный на величину δср .
Сигнал текущей скорости хода с датчика 2 поступает на два входа блока 12 перемножения, на выходе которого вырабатывается сигнал квадрата скорости хода, который поступает на первые входы блоков 11 и 13 перемножения. На вторые входы блоков 11 и 13 поступает сигнал δ′ и δ , таким образом формируются сигналы C3V2δ, и C6V2 δ . Сигналы C Vи C5VyV вырабатываются на выходах блоков 14 и 15 перемножения и поступают соответственно на входы интеграторов 9 и 10. Выходной сигнал оценки угловой скорости судна с интегратора 9 поступает на первый вход сумматора 16, на второй (инверсный) вход которого поступает с выхода интегратора 7 сигнал угловой скорости, а на выходе сумматора 16 формируется невязка вида
ω - (3)
Невязка (3) и выход с датчика 1 углового ускорения поступают на вход интегратора 7. Таким образом формируется несмещенный сигнал угловой скорости путем интегрирования сигнала углового ускорения:
= + K(ω - ) где - сигнал углового ускорения, снимаемый с датчика 1;
- сигнал на входе интегратора 7.
ω - (3)
Невязка (3) и выход с датчика 1 углового ускорения поступают на вход интегратора 7. Таким образом формируется несмещенный сигнал угловой скорости путем интегрирования сигнала углового ускорения:
= + K(ω - ) где - сигнал углового ускорения, снимаемый с датчика 1;
- сигнал на входе интегратора 7.
Таким образом, наличие блока 18 восстановления угловой скорости позволяет устранять дрейф в сигнале после интегрирования углового ускорения с датчика 1.
Для формирования закона управления рулевым приводом на вход сумматора-усилителя 5 поступает сумма сигналов , которая поступает на вход рулевого привода 6:
= K1δ + K + ( - ) - KзV2δ где К1˙δ - вырабатывается на выходе датчика 3;
- сигнал задания скорости циркуляции судна с задатчика 4;
K - сигнал углового ускорения судна, снимаемый с датчика 1;
- сигнал несмещенной угловой скорости, вырабатываемый интегратором 7.
= K1δ + K + ( - ) - KзV2δ где К1˙δ - вырабатывается на выходе датчика 3;
- сигнал задания скорости циркуляции судна с задатчика 4;
K - сигнал углового ускорения судна, снимаемый с датчика 1;
- сигнал несмещенной угловой скорости, вырабатываемый интегратором 7.
Сигнал V2 δ поступает на вход сумматора-усилителя 5 с выхода блока 11 перемножения. Этот сигнал позволяет перестраивать закон управления при изменении скорости хода судна, т.е. адаптироваться к изменению динамических характеристик судна.
Устройство может использоваться не только на морских судах, но и на речных. На существующих речных судах в подавляющих случаях нельзя использовать существующие авторулевые, так как эти суда не оборудованы гирокомпасами, которые необходимы для авторулевых. Достоинствами устройства являются также простота конструкции, дешевизна и безотказность благодаря использованию современных угловых акселерометров. Кроме того, достоинством являются высококачественные сигналы (в смысле динамических характеристик), что позволяет эффективно использовать устройство и на судах, не устойчивых по курсу.
Claims (1)
- УСТРОЙСТВО УПРАВЛЕНИЯ УГЛОВЫМ ДВИЖЕНИЕМ СУДНА, содержащее датчик перекладки руля и задатчик угловой скорости, выходы которых подключены соответственно к первому и второму входам сумматора-усилителя, к выходу которого подключен вход рулевого привода, датчик углового ускорения, выходом подключенный к третьему входу сумматора-усилителя непосредственно и через первый интегратор к его четвертому входу, отличающееся тем, что в него введены первый сумматор, датчик скорости хода и блок восстановления угловой скорости, содержащий второй - четвертый интеграторы, первый - пятый блоки перемножения и второй сумматор, при этом выход датчика перекладки руля подключен к первому входу блока восстановления угловой скорости, выход датчика скорости хода - к второму входу блока восстановления угловой скорости, первый выход которого соединен с пятым входом сумматора-усилителя, а второй выход - с первым входом первого сумматора, второй вход и выход которого подключены соответственно к выходу и второму входу первого интегратора, причем выход второго интегратора, первый вход которого является первым входом блока восстановления угловой скорости, подключен к своему второму входу и через второй сумматор соединен с первым входом первого блока перемножения, выход которого является первым выходом блока восстановления угловой скорости и подключен к первому входу третьего интегратора, выход второго блока перемножения, входы которого объединены и являются вторым входом блока восстановления угловой скорости, подключен к второму входу первого и первому входу третьего блоков перемножения, второй вход третьего блока перемножения соединен с первым входом второго интегратора и вторым входом второго сумматора, выход третьего интегратора является вторым выходом блока восстановления угловой скорости и соединен с первыми входами четвертого интегратора и четвертого блока перемножения, выход которого подключен к второму входу третьего интегратора, третий вход которого соединен с первым входом пятого блока перемножения и с выходом четвертого интегратора, второй вход которого подключен к выходу третьего блока перемножения, а третий вход - к выходу пятого блока перемножения, входы второго блока перемножения соединены с вторыми входами четвертого и пятого блоков перемножения.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
SU5031140 RU2029346C1 (ru) | 1992-01-27 | 1992-01-27 | Устройство управления угловым движением судна |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
SU5031140 RU2029346C1 (ru) | 1992-01-27 | 1992-01-27 | Устройство управления угловым движением судна |
Publications (1)
Publication Number | Publication Date |
---|---|
RU2029346C1 true RU2029346C1 (ru) | 1995-02-20 |
Family
ID=21598771
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
SU5031140 RU2029346C1 (ru) | 1992-01-27 | 1992-01-27 | Устройство управления угловым движением судна |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2029346C1 (ru) |
-
1992
- 1992-01-27 RU SU5031140 patent/RU2029346C1/ru active
Non-Patent Citations (3)
Title |
---|
1. Авторское свидетельство СССР N 337300, кл. B 63B 25/04, 1971. * |
2. Авторское свидетельство СССР N 1150155, кл. B 63B 25/04, 1985. * |
3. Авторское свидетельство СССР N 1529182, кл. G 05D 1/00, 1987. * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10747226B2 (en) | Adaptive autopilot control systems and methods | |
US3844242A (en) | Apparatus for automatic dynamic positioning and steering systems | |
JPH08249060A (ja) | 自律型水中航走装置 | |
CN113608534B (zh) | 一种无人艇跟踪控制方法及系统 | |
CN113467231A (zh) | 基于侧滑补偿ilos制导律的无人艇路径跟踪方法 | |
JP2000302098A (ja) | 自動方位設定方法とその装置 | |
US5313397A (en) | Autopilot system for a vessel | |
RU2029346C1 (ru) | Устройство управления угловым движением судна | |
RU2223197C1 (ru) | Аппаратура автоматического управления движением судна | |
JP3033571B1 (ja) | 潜水船の深度保持制御方式 | |
RU182886U1 (ru) | Система угловой стабилизации | |
Jin et al. | A real-time vision-based stationkeeping system for underwater robotics applications | |
KR830005968A (ko) | 3차원 모방 제어 방식 | |
RU194542U1 (ru) | Система угловой стабилизации | |
RU186492U1 (ru) | Система угловой стабилизации | |
JPS59220496A (ja) | 船舶の自動操舵装置 | |
SU1150155A1 (ru) | Устройство дл управлени движением судна | |
RU2133491C1 (ru) | Устройство управления движением судна | |
SU979204A1 (ru) | Устройство управлени движением судна | |
RU140964U1 (ru) | Система умерения бортовой качки судна на подводных крыльях | |
EP0357660B1 (en) | Correction of errors in autopilots | |
JP2990878B2 (ja) | 水中航走体の自動操縦装置 | |
RU211357U1 (ru) | Система боковой стабилизации | |
SU1615678A1 (ru) | Система динамического позиционировани судном | |
SU1529182A1 (ru) | Система стабилизации курса судна |