Навігація по Морям Без Людського Дотику

Інерційні вимірювальні пристрої (ІВП) та злиття датчиків

Автономні кораблі значною мірою покладаються на ІВП для визначення свого положення та орієнтації в просторі. Ці пристрої зазвичай складаються з акселерометрів, які вимірюють лінійне прискорення вздовж трьох ортогональних осей, і гіроскопів, які вимірюють кутову швидкість навколо тих самих осей. Виміряні прискорення та кутові швидкості є в своїй основі шумними; тому для оцінки стану корабля (положення, швидкість, орієнтація) з більшою точністю використовуються складні фільтраційні методи, такі як фільтри Калмана.

Злиття датчиків об'єднує дані від кількох ІВП, а також від інших датчиків, таких як GPS та радари, щоб пом’якшити окремі помилки датчиків. Фільтр Калмана рекурсивно оновлює ці оцінки на основі математичної моделі динаміки корабля та вимірювань, забезпечуючи надійне рішення навіть у складних умовах.

ẋ = F - Bω + H(x)

Гідродинамічне моделювання та рушійні сили

Рух судна визначається другим законом Ньютона: F = ma, де F – це чиста сила, що діє на судно, а m – його маса. Однак для визначення цієї чистої сили необхідно розуміти гідродинамічні сили – зокрема, опір та рушійні сили. Сила опору (Fd) залежить від щільності рідини (ρ), швидкості судна (v) та коефіцієнта форми опору (Cd), який зазвичай виражається як Cd = k * V^2, де k – безрозмірна константа, що залежить від форми корпусу, а V – швидкість судна.

Рушійна сила (Fp) виникає в результаті взаємодії гвинта з водою. Ця сила може бути наближено обчислена за допомогою рівняння імпульсного тяги: Fp = ρAv(ωr), де ρ – щільність рідини, A – площа гвинта, v – швидкість судна та ωr – швидкість обертання гвинта.

F_net = Fp - Fd

Аналіз Стабільності – Моменти Інерції та Нахил

Критичним аспектом навігації автономних суден є забезпечення стабільності. Орієнтація судна визначається взаємодією між силою відновлення (наприклад, від гіроскопу) та зовнішніми моментомми, переважно зумовленими впливом хвиль. Кутову прискореність (α) навколо осі визначають за рівнянням: α = -B(ω/r) + C/I, де B – коефіцієнт гасіння, ω – кутова швидкість, r – відстань від осі обертання до прикладеного моменту, а I – момент інерції.

Момент інерції (I) описує опір тіла до прискорення обертання. Він залежить від розподілу маси всередині судна та осі обертання. Правильне визначення та контроль цих моментів є необхідним для запобігання надмірному нахилу.

I = ∫r² dm

Системи управління – зворотні зв’язки та керування ПІД

Автономна навігація використовує цикли зворотного зв’язку для підтримки бажаних станів судна. Ці цикли безперервно відстежують фактичний стан судна (отриманий від інерціальних вимірювальних блоків – ІВБ) та порівнюють його з бажаним станом, встановленим навігаційною системою. Різниця, або сигнал помилки, використовується для коригування тягового зусилля або кута повороту керма за допомогою контролера.

Контролери пропорційно-інтегрально-диференційні (ПІД) широко використовуються. Термін пропорційної дії реагує на поточну помилку, термін інтегрування враховує накопичену помилку з часом, а термін диференціювання прогнозує майбутню помилку на основі швидкості зміни помилки. Налаштування цих параметрів є критично важливим для досягнення стабільного та чутливого управління.

∫e(t) dt = ∫∫u(t) dt

Часті запитання

Спробуйте наживо

Усе, що вище, працює прямо у вашому браузері — відкрийте Inverse Kinematics (FABRIK) і змінюйте параметри під час роботи. Нічого не встановлюється, нічого не завантажується на сервер, уся модель живе в одній вкладці.