Новая Π¨ΠΊΠΎΠ»Π° - ΠΎΠ½Π»Π°ΠΉΠ½-школа ΠΏΠΎΠ΄Π³ΠΎΡ‚ΠΎΠ²ΠΊΠΈ ΠΊ Π•Π“Π­
Π—Π°Π΄Π°Ρ‡Π° Π—Π°Π΄Π°Ρ‡Π° β„–3610170
А
Аноним
03 мая 2026 14:04 Β· ΠΏΡƒΠ±Π»ΠΈΡ‡Π½Ρ‹ΠΉ вопрос
А
Аноним

πŸ“Π’Π΅ΠΌΠ° ΡƒΡ€ΠΎΠΊΠ°: Π“Π»ΠΎΠ±Π°Π»ΡŒΠ½Ρ‹Π΅ ΠΈ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ систСмы позиционирования. ВСория Ρ€ΡƒΡ‡Π½ΠΎΠ³ΠΎ управлСния бСспилотным Π²ΠΎΠ·Π΄ΡƒΡˆΠ½Ρ‹ΠΌ судном. βœ…

ΠžΡ‚Π²Π΅Ρ‚ нСйросСти
03 мая 2026 14:04

ΠžΡ‚Π»ΠΈΡ‡Π½ΠΎ. НиТС ΠΏΠΎΠ΄Ρ€ΠΎΠ±Π½ΠΎΠ΅ объяснСниС ΠΏΠΎ Ρ‚Π΅ΠΌΠ΅: Π³Π»ΠΎΠ±Π°Π»ΡŒΠ½Ρ‹Π΅ ΠΈ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ систСмы позиционирования, Π° Ρ‚Π°ΠΊΠΆΠ΅ тСория Ρ€ΡƒΡ‡Π½ΠΎΠ³ΠΎ управлСния бСспилотным Π²ΠΎΠ·Π΄ΡƒΡˆΠ½Ρ‹ΠΌ судном. ΠŸΠΎΠ΄ΠΎΠΉΠ΄Ρ‘Ρ‚ для ΡΡ‚Π°Ρ€ΡˆΠ΅ΠΉ ΡˆΠΊΠΎΠ»Ρ‹ ΠΈ Π½Π°Ρ‡Π°Π»ΡŒΠ½ΠΎΠ³ΠΎ уровня курсов ΠΏΠΎ Ρ€ΠΎΠ±ΠΎΡ‚ΠΎΡ‚Π΅Ρ…Π½ΠΈΠΊΠ΅/Π°Π²ΠΈΠΎΠ½ΠΈΠΊΠ΅.

  1. Π“Π»ΠΎΠ±Π°Π»ΡŒΠ½Ρ‹Π΅ ΠΈ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ систСмы позиционирования β€” ΠΎΠ±Ρ‰ΠΈΠ΅ понятия
  • Π“Π»ΠΎΠ±Π°Π»ΡŒΠ½Ρ‹Π΅ систСмы позиционирования (GNSS)
    • Π§Ρ‚ΠΎ это: Π½Π°Π±ΠΎΡ€ спутниковых Π½Π°Π²ΠΈΠ³Π°Ρ†ΠΈΠΎΠ½Π½Ρ‹Ρ… систСм (Π½Π°ΠΏΡ€ΠΈΠΌΠ΅Ρ€, GPS, GLONASS, Galileo, BeiDou). ΠŸΡ€ΠΈΡ‘ΠΌΠ½ΠΈΠΊ Π½Π° ΠΊΠΎΠΏΡ‚Π΅Ρ€Π΅ ΠΏΡ€ΠΈΠ½ΠΈΠΌΠ°Π΅Ρ‚ сигналы ΠΈ ΠΏΠΎ Π²Ρ€Π΅ΠΌΠ΅Π½ΠΈ ΠΏΡ€ΠΈΡ…ΠΎΠ΄Π° сигналов рассчитываСт гСографичСскиС ΠΊΠΎΠΎΡ€Π΄ΠΈΠ½Π°Ρ‚Ρ‹.
    • Π§Ρ‚ΠΎ Π΄Π°Π΅Ρ‚: Π³Π»ΠΎΠ±Π°Π»ΡŒΠ½Ρ‹Π΅ ΠΊΠΎΠΎΡ€Π΄ΠΈΠ½Π°Ρ‚Ρ‹ Π² гСодСзичСской систСмС (ΠΎΠ±Ρ‹Ρ‡Π½ΠΎ WGS84) β€” ΡˆΠΈΡ€ΠΎΡ‚Π°, Π΄ΠΎΠ»Π³ΠΎΡ‚Π° ΠΈ высота.
    • ΠŸΡ€Π΅ΠΈΠΌΡƒΡ‰Π΅ΡΡ‚Π²Π° ΠΈ ограничСния: outdoors большая Ρ‚ΠΎΡ‡Π½ΠΎΡΡ‚ΡŒ (часто 1–3 ΠΌ ΠΈΠ»ΠΈ Π»ΡƒΡ‡ΡˆΠ΅ ΠΏΡ€ΠΈ Ρ…ΠΎΡ€ΠΎΡˆΠ΅ΠΌ сигналС); indoors сигнал слабССт ΠΈΠ»ΠΈ отсутствуСт.
    • Π’ΠΈΠΏΠΈΡ‡Π½Ρ‹Π΅ источники ошибок: Π·Π°Π΄Π΅Ρ€ΠΆΠΊΠΈ Π² атмосфСрС (ионисфСрная ΠΈ ионосфСра), ΠΌΠ½ΠΎΠ³ΠΎΠ»ΡƒΡ‡Π΅Π²ΠΎΡΡ‚ΡŒ (multipath), отклонСния часов спутников ΠΈ ΠΏΡ€ΠΈΡ‘ΠΌΠ½ΠΈΠΊΠ°, гСомСтрия спутников (DOP).
    • ΠšΠΎΠ½Π²Π΅Ρ€Ρ‚Π°Ρ†ΠΈΡ Π² Π»ΠΎΠΊΠ°Π»ΡŒΠ½ΡƒΡŽ Ρ€Π°ΠΌΠΊΡƒ: для управлСния Π΄Ρ€ΠΎΠ½ΠΎΠΌ ΡƒΠ΄ΠΎΠ±Π½ΠΎ Ρ€Π°Π±ΠΎΡ‚Π°Ρ‚ΡŒ Π½Π΅ с ΡˆΠΈΡ€ΠΎΡ‚ΠΎΠΉ-Π΄ΠΎΠ»Π³ΠΎΡ‚ΠΎΠΉ, Π° Π² локальной систСмС ENU (East-North-Up) ΠΎΡ‚Π½ΠΎΡΠΈΡ‚Π΅Π»ΡŒΠ½ΠΎ Π²Ρ‹Π±Ρ€Π°Π½Π½ΠΎΠΉ ΠΎΡ‚ΠΏΡ€Π°Π²Π½ΠΎΠΉ Ρ‚ΠΎΡ‡ΠΊΠΈ (home). Π­Ρ‚ΠΎ дСлаСтся Ρ‡Π΅Ρ€Π΅Π· ΠΏΡ€Π΅ΠΎΠ±Ρ€Π°Π·ΠΎΠ²Π°Π½ΠΈΠ΅ гСодСзичСских ΠΊΠΎΠΎΡ€Π΄ΠΈΠ½Π°Ρ‚ Π² ECEF, Π° Π·Π°Ρ‚Π΅ΠΌ Π² ENU Ρ‡Π΅Ρ€Π΅Π· ΠΎΠΏΠΎΡ€Π½ΡƒΡŽ Ρ‚ΠΎΡ‡ΠΊΡƒ.
  • Π›ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ систСмы позиционирования
    • Π§Ρ‚ΠΎ это: систСмы ΠΈ сСнсоры, ΠΊΠΎΡ‚ΠΎΡ€Ρ‹Π΅ Π΄Π°ΡŽΡ‚ ΠΎΡ‚Π½ΠΎΡΠΈΡ‚Π΅Π»ΡŒΠ½ΠΎΠ΅ ΠΈΠ»ΠΈ локальноС ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ Π² ΠΏΠΎΠΌΠ΅Ρ‰Π΅Π½ΠΈΠΈ ΠΈΠ»ΠΈ рядом с ΠΊΠΎΠΏΡ‚Π΅Ρ€ΠΎΠΌ.
    • ΠŸΡ€ΠΈΠΌΠ΅Ρ€Ρ‹:
      • IMU (ΠΈΠ½Π΅Ρ€Ρ†ΠΈΠ°Π»ΡŒΠ½Π°Ρ ΠΈΠ·ΠΌΠ΅Ρ€ΠΈΡ‚Π΅Π»ΡŒΠ½Π°Ρ Π΅Π΄ΠΈΠ½ΠΈΡ†Π°): аксСлСромСтры ΠΈ гироскопы. Π—Π°ΠΌΠ΅Ρ€Ρ‹ скорости ΠΈ ΡƒΠ³Π»ΠΎΠ²Ρ‹Ρ… скоростСй. Π₯ΠΎΡ€ΠΎΡˆΠΈΠ΅ для краткосрочного отслСТивания, Π½ΠΎ Π΄Ρ€Π΅ΠΉΡ„ΡƒΡŽΡ‚ Π±Π΅Π· Π²Π½Π΅ΡˆΠ½ΠΈΡ… ΠΊΠΎΡ€Ρ€Π΅ΠΊΡ†ΠΈΠΉ.
      • Π’ΠΈΠ·ΡƒΠ°Π»ΡŒΠ½ΠΎ-ΠΈΠ½Π΅Ρ€Ρ†ΠΈΠ°Π»ΡŒΠ½Π°Ρ одомСтрия/SLAM (VIO/VO, Visual SLAM): Π½Π° основС ΠΊΠ°ΠΌΠ΅Ρ€ ΠΈ IMU опрСдСляСтся Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΠ΅ ΠΈ строится ΠΊΠ°Ρ€Ρ‚Π° окруТСния.
      • LiDAR SLAM: Ρ‚ΠΎΡ‡Π½Ρ‹Π΅ измСрСния Π΄Π°Π»ΡŒΠ½ΠΎΡΡ‚ΠΈ для Π»ΠΎΠΊΠ°Π»ΠΈΠ·Π°Ρ†ΠΈΠΈ Π² Π±ΠΎΠ»ΡŒΡˆΠΈΡ… Π·ΠΎΠ½Π°Ρ….
      • UWB ΠΈ Π΄Ρ€ΡƒΠ³ΠΈΠ΅ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ систСмы позиционирования: indoors ΠΈΠ»ΠΈ Π² мСстах, Π³Π΄Π΅ GNSS нСдоступСн.
    • Π§Ρ‚ΠΎ Π΄Π°ΡŽΡ‚: Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ ΠΊΠΎΠΎΡ€Π΄ΠΈΠ½Π°Ρ‚Ρ‹ ΠΈ ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΡŽ Π² Ρ€Π΅Π°Π»ΡŒΠ½ΠΎΠΌ Π²Ρ€Π΅ΠΌΠ΅Π½ΠΈ, ΡƒΡΡ‚ΠΎΠΉΡ‡ΠΈΠ²ΠΎΡΡ‚ΡŒ ΠΊ ΠΏΠΎΡ‚Π΅Ρ€Π΅ сигнала GNSS, Π²ΠΎΠ·ΠΌΠΎΠΆΠ½ΠΎΡΡ‚ΡŒ Ρ€Π°Π±ΠΎΡ‚Π°Ρ‚ΡŒ indoors.
  1. Как GNSS ΠΈ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ систСмы Ρ€Π°Π±ΠΎΡ‚Π°ΡŽΡ‚ вмСстС (сСнсорноС слСплСниС)
  • Основной ΠΏΠΎΠ΄Ρ…ΠΎΠ΄: ΠΎΡ†Π΅Π½ΠΊΠ° ΠΏΠΎΠ·ΠΈΡ†ΠΈΠΈ ΠΈ ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΠΈ с использованиСм Ρ„ΠΈΠ»ΡŒΡ‚Ρ€Π°Ρ†ΠΈΠΈ (ΠΎΠ±Ρ‹Ρ‡Π½ΠΎ EKF β€” Ρ€Π°ΡΡˆΠΈΡ€Π΅Π½Π½Ρ‹ΠΉ Ρ„ΠΈΠ»ΡŒΡ‚Ρ€ Π€ΡƒΡ€ΡŒΠ΅) Π½Π° основС ΠΌΠΎΠ΄Π΅Π»Π΅ΠΉ двиТСния ΠΈ ΠΈΠ·ΠΌΠ΅Ρ€Π΅Π½ΠΈΠΉ.
  • Π§Ρ‚ΠΎ Π²Ρ…ΠΎΠ΄ΠΈΡ‚ Π² Ρ‚ΠΈΠΏΠΈΡ‡Π½ΡƒΡŽ схСму:
    • БостояниС x: позиция (x, y, z), ΡΠΊΠΎΡ€ΠΎΡΡ‚ΡŒ (v_x, v_y, v_z), ориСнтация (Π½Π°ΠΏΡ€ΠΈΠΌΠ΅Ρ€, ΠΊΠ²Π°Ρ‚Π΅Ρ€Π½ΠΈΠΎΠ½Ρ‹ ΠΈΠ»ΠΈ ΡƒΠ³Π»Ρ‹) ΠΈ Π²ΠΎΠ·ΠΌΠΎΠΆΠ½Ρ‹Π΅ байасы сСнсоров.
    • МодСль двиТСния: ΠΊΠ°ΠΊ ΠΊΠΎΠΏΡ‚Π΅Ρ€ двиТСтся ΠΌΠ΅ΠΆΠ΄Ρƒ ΠΊΠ°Π΄Ρ€ΠΎΠ²Ρ‹ΠΌΠΈ Π·Π°ΠΌΠ΅Ρ€Π°ΠΌΠΈ (ΠΈΡΠΏΠΎΠ»ΡŒΠ·ΡƒΠ΅Ρ‚ΡΡ IMU: ускорСния ΠΈ ΡƒΠ³Π»ΠΎΠ²Ρ‹Π΅ скорости).
    • МодСль ΠΈΠ·ΠΌΠ΅Ρ€Π΅Π½ΠΈΠΉ: GNSS-ΠΏΠΎΠ·ΠΈΡ†ΠΈΠΈ (ΠΈ ΠΈΠ½ΠΎΠ³Π΄Π° ΡΠΊΠΎΡ€ΠΎΡΡ‚ΡŒ) ΠΊΠ°ΠΊ наблюдСния ΠΊ ΡΠΎΡΡ‚ΠΎΡΠ½ΠΈΡŽ, ΠΊΠ°ΠΌΠ΅Ρ€Π½Ρ‹Π΅/Π»ΠΈΠ΄Π°Ρ€Π½Ρ‹Π΅ измСрСния ΠΊΠ°ΠΊ Π΄ΠΎΠΏΠΎΠ»Π½ΠΈΡ‚Π΅Π»ΡŒΠ½Ρ‹Π΅ наблюдСния.
  • ΠŸΡ€Π΅ΠΈΠΌΡƒΡ‰Π΅ΡΡ‚Π²Π° Ρ‚Π°ΠΊΠΎΠ³ΠΎ сопряТСния:
    • GNSS обСспСчиваСт Π³Π»ΠΎΠ±Π°Π»ΡŒΠ½ΡƒΡŽ привязку ΠΈ ΠΊΠΎΡ€Ρ€Π΅ΠΊΡ†ΠΈΡŽ Π΄Ρ€Π΅ΠΉΡ„Π° ΠΎΡ‚ IMU.
    • Π›ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ сСнсоры ΠΊΠΎΠΌΠΏΠ΅Π½ΡΠΈΡ€ΡƒΡŽΡ‚ ΠΏΠΎΡ‚Π΅Ρ€ΠΈ сигнала GNSS, обСспСчивая Π½Π΅ΠΏΡ€Π΅Ρ€Ρ‹Π²Π½ΡƒΡŽ Π»ΠΎΠΊΠ°Π»ΠΈΠ·Π°Ρ†ΠΈΡŽ.
    • Π£Π»ΡƒΡ‡ΡˆΠ°ΡŽΡ‚ΡΡ Ρ‚ΠΎΡ‡Π½ΠΎΡΡ‚ΡŒ ΠΈ ΡƒΡΡ‚ΠΎΠΉΡ‡ΠΈΠ²ΠΎΡΡ‚ΡŒ ΠΊ ΡˆΡƒΠΌΠ°ΠΌ ΠΈ ошибкам ΠΎΠ΄Π½ΠΎΠ³ΠΎ сСнсора.
  1. ВСория Ρ€ΡƒΡ‡Π½ΠΎΠ³ΠΎ управлСния бСспилотным Π²ΠΎΠ·Π΄ΡƒΡˆΠ½Ρ‹ΠΌ судном (manual control)
  • Π§Ρ‚ΠΎ ΠΏΠΎΠ½ΠΈΠΌΠ°ΡŽΡ‚ ΠΏΠΎΠ΄ Ρ€ΡƒΡ‡Π½Ρ‹ΠΌ ΡƒΠΏΡ€Π°Π²Π»Π΅Π½ΠΈΠ΅ΠΌ
    • ΠŸΠΈΠ»ΠΎΡ‚ Π½Π°ΠΏΡ€ΡΠΌΡƒΡŽ управляСт Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΠ΅ΠΌ ΠΊΠΎΠΏΡ‚Π΅Ρ€Π° Ρ‡Π΅Ρ€Π΅Π· стики/ΠΊΠ½ΠΎΠΏΠΊΠΈ: ΡƒΠΏΡ€Π°Π²Π»Π΅Π½ΠΈΠ΅ тягой (высота), ΠΊΡ€Ρ‹Π»ΠΎΠΌ-Ρ€ΠΎΠ»Π»ΠΎΠΌ, ΠΊΡ€Π΅Π½ΠΎΠΌ-ΠΏΠΈΡ‚Ρ‡Π΅ΠΌ ΠΈ рысканиСм (yaw).
    • Π’ Π±ΠΎΠ»ΡŒΡˆΠΈΠ½ΡΡ‚Π²Π΅ систСм Π΅ΡΡ‚ΡŒ Ρ€Π΅ΠΆΠΈΠΌ Ρ€ΡƒΡ‡Π½ΠΎΠ³ΠΎ управлСния ΠΈ Ρ€Π΅ΠΆΠΈΠΌΡ‹ с ΠΎΠ³Ρ€Π°Π½ΠΈΡ‡Π΅Π½ΠΈΠ΅ΠΌ (stabilize, altitude hold, loiter ΠΈ Ρ‚. Π΄.). Π’ Ρ€ΡƒΡ‡Π½ΠΎΠΌ Ρ€Π΅ΠΆΠΈΠΌΠ΅ Π°Π²Ρ‚ΠΎΠΏΠΈΠ»ΠΎΡ‚ ΠΌΠΎΠΆΠ΅Ρ‚ лишь ΠΎΠ±Π΅ΡΠΏΠ΅Ρ‡ΠΈΠ²Π°Ρ‚ΡŒ Π±Π°Π·ΠΎΠ²ΡƒΡŽ ΡΡ‚Π°Π±ΠΈΠ»ΠΈΠ·Π°Ρ†ΠΈΡŽ, Π½ΠΎ основная ΠΎΡ‚Π²Π΅Ρ‚ΡΡ‚Π²Π΅Π½Π½ΠΎΡΡ‚ΡŒ Π·Π° Π½Π°ΠΏΡ€Π°Π²Π»Π΅Π½ΠΈΠ΅ ΠΈ ΡΠΊΠΎΡ€ΠΎΡΡ‚ΡŒ Π»Π΅ΠΆΠΈΡ‚ Π½Π° ΠΏΠΈΠ»ΠΎΡ‚Π΅.
  • Випичная Π°Ρ€Ρ…ΠΈΡ‚Π΅ΠΊΡ‚ΡƒΡ€Π° управлСния
    • ВстроСнная Ρ†Π΅ΠΏΡŒ управлСния состоит ΠΈΠ· Π΄Π²ΡƒΡ… ΡƒΡ€ΠΎΠ²Π½Π΅ΠΉ:
      • Π’Π½ΡƒΡ‚Ρ€Π΅Π½Π½ΠΈΠΉ Ρ†ΠΈΠΊΠ» (rate/attitude loop): ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»ΠΈΡ€ΡƒΠ΅Ρ‚ ΡƒΠ³Π»ΠΎΠ²Ρ‹Π΅ скорости ΠΈΠ»ΠΈ ΡƒΠ³Π»Ρ‹ (roll, pitch, yaw). ΠžΠ±Ρ‹Ρ‡Π½ΠΎ рСализуСтся ΠΊΠ°ΠΊ PID-ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»Π»Π΅Ρ€ ΠΏΠΎ rates ΠΈΠ»ΠΈ ΠΏΠΎ позициям.
      • Π’Π½Π΅ΡˆΠ½ΠΈΠΉ Ρ†ΠΈΠΊΠ» (position/altitude loop): управляСт ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ΠΌ ΠΏΠΎ Ρ‚Ρ€Ρ‘ΠΌ осям ΠΈ высотС. Часто ΠΏΡ€ΠΈΠΌΠ΅Π½ΡΡŽΡ‚ внСшний Π½Π°Π±ΠΎΡ€ ΠΊΠΎΠΌΠ°Π½Π΄ (target position) ΠΈ пСрСводят ΠΈΡ… Π² Ρ†Π΅Π»Π΅Π²Ρ‹Π΅ скорости, ΠΊΠΎΡ‚ΠΎΡ€Ρ‹Π΅ Π·Π°Ρ‚Π΅ΠΌ приводят ΠΊ Π½ΡƒΠΆΠ½Ρ‹ΠΌ ΡƒΠ³Π»ΠΎΠ²Ρ‹ΠΌ ΠΊΠΎΠΌΠ°Π½Π΄Π°ΠΌ Ρ‡Π΅Ρ€Π΅Π· Π²Π½ΡƒΡ‚Ρ€Π΅Π½Π½ΠΈΠΉ Ρ†ΠΈΠΊΠ».
    • Π’ Ρ€ΡƒΡ‡Π½ΠΎΠΌ Ρ€Π΅ΠΆΠΈΠΌΠ΅ ΠΏΠΈΠ»ΠΎΡ‚ ΠΏΠΎΠ΄Π°Ρ” сигналы Π² Ρ‡Π΅Ρ‚Ρ‹Ρ€Π΅ ΠΊΠ°Π½Π°Π»Π°: Π³Π°Π· (throttle), ΠΊΡ€Π΅Π½ (roll), Ρ€Ρ‹ΡΠΊΠ°Π½ΡŒΠ΅ (yaw), Ρ‚Π°Π½Π³Π°ΠΆ (pitch). Π­Ρ‚ΠΈ сигналы ΠΊΠΎΠ½Π²Π΅Ρ€Ρ‚ΠΈΡ€ΡƒΡŽΡ‚ΡΡ Π² скоростныС ΠΊΠΎΠΌΠ°Π½Π΄Ρ‹ Ρ€ΠΎΡ‚ΠΎΡ€ΠΎΠ² ΠΈ Π²Ρ€Π°Ρ‰Π΅Π½ΠΈΠ΅ ΠΌΠΎΡ‚ΠΎΡ€ΠΎΠ², Ρ‡Ρ‚ΠΎΠ±Ρ‹ Π΄ΠΎΡΡ‚ΠΈΠ³Π½ΡƒΡ‚ΡŒ Π½ΡƒΠΆΠ½ΠΎΠΉ ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΠΈ ΠΈ пСрСмСщСния.
  • ΠŸΡ€ΠΈΠΌΠ΅Ρ€ шагов Π² Ρ€Π°Π±ΠΎΡ‚Π΅ ΡƒΠΏΡ€Π°Π²Π»ΡΡŽΡ‰Π΅ΠΉ систСмы (ΡƒΠΏΡ€ΠΎΡ‰Ρ‘Π½Π½Ρ‹ΠΉ ΠΎΠ±Π·ΠΎΡ€)
    1. БСнсоры Π΄Π°ΡŽΡ‚ Ρ‚Π΅ΠΊΡƒΡ‰Π΅Π΅ состояниС: ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΡŽ (roll, pitch, yaw) ΠΈ, ΠΏΡ€ΠΈ Π½Π°Π»ΠΈΡ‡ΠΈΠΈ, ΡΠΊΠΎΡ€ΠΎΡΡ‚ΡŒ ΠΈ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ Π² локальной систСмС ENU.
    2. ΠŸΠΈΠ»ΠΎΡ‚ ΠΏΠΎΠ΄Π°Ρ‘Ρ‚ ΠΊΠΎΠΌΠ°Π½Π΄Ρ‹ ΠΏΠΎ стикам: Π½Π°ΠΏΡ€ΠΈΠΌΠ΅Ρ€, осям pitch/roll/yaw ΠΈ throttle.
    3. Автопилот примСняСт Π²Π½ΡƒΡ‚Ρ€Π΅Π½Π½ΠΈΠ΅ ΠŸΠ˜Π”-Ρ†ΠΈΠΊΠ»Ρ‹:
      • Rate controller: стрСмится привСсти Ρ‚Π΅ΠΊΡƒΡ‰ΠΈΠ΅ ΡƒΠ³Π»ΠΎΠ²Ρ‹Π΅ скорости ΠΊ Π·Π°Π΄Π°Π½Π½Ρ‹ΠΌ (ΠΈΠ»ΠΈ ΠΊ Π½ΡƒΠΆΠ½ΠΎΠΌΡƒ ΡƒΠ³Π»Ρƒ).
      • Attitude controller: ΠΏΠΎΠ΄Π΄Π΅Ρ€ΠΆΠΈΠ²Π°Π΅Ρ‚ ΠΆΠ΅Π»Π°Π΅ΠΌΡ‹Π΅ ΡƒΠ³Π»Ρ‹ (Π² Ρ€Π΅ΠΆΠΈΠΌΠ΅ stabilization) ΠΈΠ»ΠΈ прямо управляСт ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ΠΌ Π² пространствС (Π² Ρ€Π΅ΠΆΠΈΠΌΠ΅ position hold).
    4. На Π²Ρ‹Ρ…ΠΎΠ΄Π΅ Ρ„ΠΎΡ€ΠΌΠΈΡ€ΡƒΡŽΡ‚ΡΡ ΠΊΠΎΠΌΠ°Π½Π΄Π½Ρ‹Π΅ сигналы для ΠΌΠΎΡ‚ΠΎΡ€ΠΎΠ², ΠΊΠΎΡ‚ΠΎΡ€Ρ‹Π΅ ΡΠΎΠ·Π΄Π°ΡŽΡ‚ Π½ΡƒΠΆΠ½ΡƒΡŽ тягу ΠΈ ΠΌΠΎΠΌΠ΅Π½Ρ‚, Ρ‡Ρ‚ΠΎΠ±Ρ‹ ΠΊΠΎΠΏΡ‚Π΅Ρ€ ΠΏΠ΅Ρ€Π΅ΡˆΡ‘Π» Π² ΠΆΠ΅Π»Π°Π΅ΠΌΠΎΠ΅ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ ΠΈΠ»ΠΈ стабилизировался Π² Π½Ρ‘ΠΌ.
  • Π’Π°ΠΆΠ½Ρ‹Π΅ понятия ΠΈ Ρ‚Π΅Ρ€ΠΌΠΈΠ½Ρ‹
    • ΠŸΠ˜Π”-рСгулятор: u(t) = Kp e(t) + Ki ∫ e(t) dt + Kd de(t)/dt, Π³Π΄Π΅ e(t) β€” ошибка ΠΌΠ΅ΠΆΠ΄Ρƒ ΠΆΠ΅Π»Π°Π΅ΠΌΡ‹ΠΌ ΠΈ Ρ‚Π΅ΠΊΡƒΡ‰ΠΈΠΌ состояниСм.
    • Inner loop vs outer loop:
      • Inner loop: быстрый ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»ΡŒ ΡƒΠ³Π»ΠΎΠ²Ρ‹Ρ… скоростСй (rates) для быстрой стабилизации ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΠΈ.
      • Outer loop: ΠΌΠ΅Π΄Π»Π΅Π½Π½Π΅Π΅ β€” ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»ΡŒ ΠΏΠΎΠ·ΠΈΡ†ΠΈΠΈ/высоты, Ρ„ΠΎΡ€ΠΌΠΈΡ€ΡƒΠ΅Ρ‚ Ρ†Π΅Π»Π΅Π²Ρ‹Π΅ ΡƒΠ³Π»Ρ‹ ΠΈΠ»ΠΈ скорости Π½Π° основС ошибки полоТСния.
    • Π‘Π΅Π·ΠΎΠΏΠ°ΡΠ½ΠΎΡΡ‚ΡŒ: гарантия запасной мощности, ΠΎΠ³Ρ€Π°Π½ΠΈΡ‡Π΅Π½ΠΈΠ΅ ΠΌΠ°ΠΊΡΠΈΠΌΠ°Π»ΡŒΠ½Ρ‹Ρ… ΡƒΠ³Π»ΠΎΠ² ΠΊΡ€Π΅Π½Π°, ограничСния высоты, Π·Π°Ρ‰ΠΈΡ‚Π° ΠΎΡ‚ ΠΏΠ΅Ρ€Π΅Π³Ρ€ΡƒΠ·ΠΎΠΊ ΠΌΠΎΡ‚ΠΎΡ€ΠΎΠ² ΠΈ Ρ‚. Π΄.
  1. ΠŸΡ€ΠΈΠΌΠ΅Ρ€ простой Π·Π°Π΄Π°Ρ‡ΠΈ ΠΏΠΎ Ρ‚Π΅ΠΌΠ΅ (пошагово) Π—Π°Π΄Π°Ρ‡Π°: ΠΎΠ±ΡŠΡΡΠ½ΠΈΡ‚ΡŒ, ΠΊΠ°ΠΊ ΠΊΠΎΠΏΡ‚Π΅Ρ€ ΡƒΠ΄Π΅Ρ€ΠΆΠΈΠ²Π°Π΅Ρ‚ Π·Π°Π΄Π°Π½Π½ΡƒΡŽ Ρ‚ΠΎΡ‡ΠΊΡƒ Π² Π½Π°Ρ€ΡƒΠΆΠ½ΠΎΠΉ срСдС, Ссли доступСн GNSS ΠΈ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ сСнсоры (IMU + ΠΊΠ°ΠΌΠ΅Ρ€a/SLAM). КакиС шаги происходят Π² систСмС?
  • Π¨Π°Π³ 1. ΠžΡ†Π΅Π½ΠΊΠ° полоТСния ΠΈ ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΠΈ
    • GNSS прСдоставляСт Π³Π»ΠΎΠ±Π°Π»ΡŒΠ½Ρ‹Π΅ ΠΊΠΎΠΎΡ€Π΄ΠΈΠ½Π°Ρ‚Ρ‹ p_g (ΡˆΠΈΡ€ΠΎΡ‚Π°, Π΄ΠΎΠ»Π³ΠΎΡ‚Π°, высота) с Π½Π΅ΠΊΠΎΡ‚ΠΎΡ€ΠΎΠΉ ΠΏΠΎΠ³Ρ€Π΅ΡˆΠ½ΠΎΡΡ‚ΡŒΡŽ.
    • Π›ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ сСнсоры (IMU, VIO/SLAM) Π΄Π°ΡŽΡ‚ ΠΎΡ‚Π½ΠΎΡΠΈΡ‚Π΅Π»ΡŒΠ½ΠΎΠ΅ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ ΠΈ ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΡŽ Π² локальной систСмС ENU с ΡƒΡ‡Ρ‘Ρ‚ΠΎΠΌ Π΄Ρ€Π΅ΠΉΡ„Π° IMU.
    • Π€ΠΈΠ»ΡŒΡ‚Ρ€ (Π½Π°ΠΏΡ€ΠΈΠΌΠ΅Ρ€ EKF) ΠΎΠ±ΡŠΠ΅Π΄ΠΈΠ½ΡΠ΅Ρ‚ Π΄Π°Π½Π½Ρ‹Π΅, давая ΠΎΡ†Π΅Π½ΠΊΡƒ состояния x = [p, v, q] (ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅, ΡΠΊΠΎΡ€ΠΎΡΡ‚ΡŒ, ориСнтация).
  • Π¨Π°Π³ 2. Π‘Ρ€Π°Π²Π½Π΅Π½ΠΈΠ΅ с Ρ†Π΅Π»Π΅Π²Ρ‹ΠΌ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ΠΌ
    • Π¦Π΅Π»Π΅Π²ΠΎΠ΅ ΠΏΠΎΠ»ΠΎΠΆΠ΅Π½ΠΈΠ΅ p_des задаётся ΠΎΠΏΠ΅Ρ€Π°Ρ‚ΠΎΡ€ΠΎΠΌ (Π½Π°ΠΏΡ€ΠΈΠΌΠ΅Ρ€, Ρ‚ΠΎΡ‡ΠΊΠ° Π½Π°Π΄ Π΄ΠΎΠΌΠΎΠΌ Π½Π° Π·Π°Π΄Π°Π½Π½ΠΎΠΉ высотС).
    • Ошибка ΠΏΠΎΠ·ΠΈΡ†ΠΈΠΈ e_p = p_des - p_est.
  • Π¨Π°Π³ 3. Π€ΠΎΡ€ΠΌΠΈΡ€ΠΎΠ²Π°Π½ΠΈΠ΅ ΡƒΠΏΡ€Π°Π²Π»ΡΡŽΡ‰Π΅ΠΉ ΠΊΠΎΠΌΠ°Π½Π΄Ρ‹
    • Outer loop: Π½Π° основС e_p формируСтся трСбуСмая ΡΠΊΠΎΡ€ΠΎΡΡ‚ΡŒ ΠΈΠ»ΠΈ Ρ‚Ρ€Π΅Π±ΡƒΠ΅ΠΌΡ‹Π΅ ΠΏΠΎΠΏΡ€Π°Π²ΠΊΠΈ ΠΏΠΎ оси x,y,z.
    • Inner loop: Π½Π° основС Ρ‚Ρ€Π΅Π±ΡƒΠ΅ΠΌΡ‹Ρ… скоростСй ΠΈΠ»ΠΈ ΡƒΠ³Π»ΠΎΠ² Ρ„ΠΎΡ€ΠΌΠΈΡ€ΡƒΡŽΡ‚ΡΡ сигналы ΠΊ rate/attitude ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»Π»Π΅Ρ€Π°ΠΌ.
    • Π Π΅Π·ΡƒΠ»ΡŒΡ‚Π°Ρ‚: ΠΏΠΈΠ»ΠΎΡ‚ ΠΌΠΎΠΆΠ΅Ρ‚ ΡƒΠ΄Π΅Ρ€ΠΆΠΈΠ²Π°Ρ‚ΡŒ ΠΊΠΎΠΏΡ‚Π΅Ρ€ Π½Π° мСстС, ΠΊΠΎΠΏΡ‚Π΅Ρ€ ΠΏΠ»Π°Π²Π½ΠΎ скоррСктируСт курс ΠΈ высоту, избСгая Ρ€Π΅Π·ΠΊΠΈΡ… Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΠΉ.
  • Π¨Π°Π³ 4. РСализация Ρ‡Π΅Ρ€Π΅Π· Ρ€Π΅ΠΆΠΈΠΌΡ‹
    • Π’ Ρ€Π΅ΠΆΠΈΠΌΠ΅ stabilization ΠΊΠΎΠΏΡ‚Π΅Ρ€ подстраиваСт Π΄Π²ΠΈΠΆΠ΅Π½ΠΈΠ΅ ΠΏΠΎΠ΄ Π΄Π΅Ρ€ΠΆΠ°Π½ΠΈΠ΅ Π·Π°Π΄Π°Π½Π½ΠΎΠΉ ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΠΈ.
    • Π’ Ρ€Π΅ΠΆΠΈΠΌΠ΅ loiter ΠΊΠΎΠΏΡ‚Π΅Ρ€ Π΄Π΅Ρ€ΠΆΠΈΡ‚ Π·Π°Π΄Π°Π½Π½ΡƒΡŽ Ρ‚ΠΎΡ‡ΠΊΡƒ, ΠΈΡΠΏΠΎΠ»ΡŒΠ·ΡƒΡ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ Π΄Π°Π½Π½Ρ‹Π΅ ΠΈ GNSS, Ρ‡Ρ‚ΠΎΠ±Ρ‹ ΠΌΠΈΠ½ΠΈΠΌΠΈΠ·ΠΈΡ€ΠΎΠ²Π°Ρ‚ΡŒ отклонСния.
    • ΠŸΡ€ΠΈ ΠΏΠΎΡ‚Π΅Ρ€Π΅ GNSS систСма ΠΏΡ€ΠΎΠ΄ΠΎΠ»ΠΆΠ°Π΅Ρ‚ ΠΈΡΠΏΠΎΠ»ΡŒΠ·ΠΎΠ²Π°Ρ‚ΡŒ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ Π΄Π°Ρ‚Ρ‡ΠΈΠΊΠΈ (IMU+VIO/LiDAR) для сохранСния полоТСния с Π΄Ρ€Π΅ΠΉΡ„ΠΎΠΌ, ΠΏΠΎΠΊΠ° сигнал вСрнётся.
  • Π¨Π°Π³ 5. Π‘Π΅Π·ΠΎΠΏΠ°ΡΠ½ΠΎΡΡ‚ΡŒ ΠΈ ΠΌΠΎΠ½ΠΈΡ‚ΠΎΡ€ΠΈΠ½Π³
    • ΠžΠ³Ρ€Π°Π½ΠΈΡ‡Π΅Π½ΠΈΠ΅ высоты ΠΈ ΡƒΠ³Π»ΠΎΠ² ΠΊΡ€Π΅Π½Π°.
    • ΠœΠΎΠ½ΠΈΡ‚ΠΎΡ€ΠΈΠ½Π³ качСства GNSS-сигнала (DOP) ΠΈ кинСматичСских ошибок, ΠΏΠ΅Ρ€Π΅ΠΊΠ»ΡŽΡ‡Π΅Π½ΠΈΠ΅ Π² Β«Ρ‡Π΅Π»ΠΎΠ²Π΅ΠΊΠΎΠΏΠΎΠ΄Π΄Π΅Ρ€ΠΆΠΈΠ²Π°Π΅ΠΌΡ‹ΠΉΒ» Ρ€Π΅ΠΆΠΈΠΌ ΠΏΡ€ΠΈ ΠΏΠ»ΠΎΡ…ΠΎΠΌ сигналС.
  1. Π§Ρ‚ΠΎ Π²Π°ΠΆΠ½ΠΎ Π·Π°ΠΏΠΎΠΌΠ½ΠΈΡ‚ΡŒ
  • GNSS обСспСчиваСт Π³Π»ΠΎΠ±Π°Π»ΡŒΠ½ΡƒΡŽ привязку ΠΈ Π½Π°Ρ€ΡƒΠΆΠ½ΡƒΡŽ Ρ‚ΠΎΡ‡Π½ΠΎΡΡ‚ΡŒ Π½Π° ΠΎΡ‚ΠΊΡ€Ρ‹Ρ‚ΠΎΠΉ мСстности; Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ сСнсоры Π²ΠΎΡΠΏΠΎΠ»Π½ΡΡŽΡ‚ ограничСния GNSS ΠΈ ΠΏΠΎΠ·Π²ΠΎΠ»ΡΡŽΡ‚ Ρ€Π°Π±ΠΎΡ‚Π°Ρ‚ΡŒ indoors.
  • Для Π½Π°Π΄Ρ‘ΠΆΠ½ΠΎΠ³ΠΎ управлСния ΠΊΠΎΠΏΡ‚Π΅Ρ€ΠΎΠΌ ΠΈΡΠΏΠΎΠ»ΡŒΠ·ΡƒΠ΅Ρ‚ΡΡ слоистая систСма: внСшний ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»Π»Π΅Ρ€ (позиция/ΡΠΊΠΎΡ€ΠΎΡΡ‚ΡŒ) ΠΈ Π²Π½ΡƒΡ‚Ρ€Π΅Π½Π½ΠΈΠΉ ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»Π»Π΅Ρ€ (ΡƒΠ³Π»Ρ‹/ΡƒΠ³Π»ΠΎΠ²Ρ‹Π΅ скорости) с использованиСм PID ΠΈΠ»ΠΈ Π°Π½Π°Π»ΠΎΠ³ΠΎΠ²Ρ‹Ρ… рСгуляторов.
  • Π€ΠΈΠ»ΡŒΡ‚Ρ€Π°Ρ†ΠΈΡ сСнсорных Π΄Π°Π½Π½Ρ‹Ρ… (EKF) ΠΎΠ±ΡŠΠ΅Π΄ΠΈΠ½ΡΠ΅Ρ‚ Π³Π»ΠΎΠ±Π°Π»ΡŒΠ½Ρ‹Π΅ измСрСния GNSS ΠΈ Π»ΠΎΠΊΠ°Π»ΡŒΠ½Ρ‹Π΅ Π΄Π°Π½Π½Ρ‹Π΅ IMU/SLAM Π² Π΅Π΄ΠΈΠ½ΠΎΠ΅ устойчивоС прСдставлСниС полоТСния ΠΈ ΠΎΡ€ΠΈΠ΅Π½Ρ‚Π°Ρ†ΠΈΠΈ.
  • Π’ ΠΎΠ±ΡƒΡ‡Π΅Π½ΠΈΠΈ ΠΈ ΠΏΡ€Π°ΠΊΡ‚ΠΈΠΊΠ΅ Π²Π°ΠΆΠ½ΠΎ ΠΏΠΎΠΌΠ½ΠΈΡ‚ΡŒ ΠΎ Ρ€Π΅ΠΆΠΈΠΌΠ°Ρ… Ρ€Π°Π±ΠΎΡ‚Ρ‹, бСзопасной настройкС ΠΎΠ³Ρ€Π°Π½ΠΈΡ‡ΠΈΡ‚Π΅Π»Π΅ΠΉ ΠΈ тСстировании Π² ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»ΠΈΡ€ΡƒΠ΅ΠΌΡ‹Ρ… условиях.
  1. ΠšΠΎΡ€ΠΎΡ‚ΠΊΠΈΠ΅ вопросы для самопровСрки
  • Π§Ρ‚ΠΎ Ρ‚Π°ΠΊΠΎΠ΅ ENU ΠΈ Π·Π°Ρ‡Π΅ΠΌ пСрСводят GNSS-ΠΊΠΎΠΎΡ€Π΄ΠΈΠ½Π°Ρ‚Ρ‹ Π² Π»ΠΎΠΊΠ°Π»ΡŒΠ½ΡƒΡŽ ENU-систСму?
  • ΠšΠ°ΠΊΠΎΠ²Ρ‹ основныС источники ошибок GNSS ΠΈ ΠΊΠ°ΠΊ ΠΈΡ… ΠΌΠΈΠ½ΠΈΠΌΠΈΠ·ΠΈΡ€ΡƒΡŽΡ‚ Π² UAV-систСмах?
  • Π’ Ρ‡Π΅ΠΌ Ρ€Π°Π·Π½ΠΈΡ†Π° ΠΌΠ΅ΠΆΠ΄Ρƒ inner loop ΠΈ outer loop Π² ΡƒΠΏΡ€Π°Π²Π»Π΅Π½ΠΈΠΈ Π΄Ρ€ΠΎΠ½ΠΎΠΌ?
  • Π§Ρ‚ΠΎ Π΄Π°Ρ‘Ρ‚ сСнсорноС слСплСниС (EKF) ΠΏΡ€ΠΈ сочСтании GNSS ΠΈ IMU?
  • КакиС Ρ€Π΅ΠΆΠΈΠΌΡ‹ Ρ€ΡƒΡ‡Π½ΠΎΠ³ΠΎ управлСния часто Π²ΡΡ‚Ρ€Π΅Ρ‡Π°ΡŽΡ‚ΡΡ Π² коммСрчСских ΠΊΠΎΠΏΡ‚Π΅Ρ€Π°Ρ… ΠΈ Ρ‡Π΅ΠΌ ΠΎΠ½ΠΈ ΠΎΡ‚Π»ΠΈΡ‡Π°ΡŽΡ‚ΡΡ?

Если Ρ…ΠΎΡ‡Π΅ΡˆΡŒ, ΠΌΠΎΠ³Ρƒ ΡΠ΄Π΅Π»Π°Ρ‚ΡŒ Π±ΠΎΠ»Π΅Π΅ ΠΊΠΎΠ½ΠΊΡ€Π΅Ρ‚Π½ΠΎΠ΅ Ρ€Π΅ΡˆΠ΅Π½ΠΈΠ΅ ΠΏΠΎΠ΄ Ρ‚Π²ΠΎΠΉ класс ΠΈΠ»ΠΈ ΠΏΠΎΠ΄Π³ΠΎΡ‚ΠΎΠ²ΠΈΡ‚ΡŒ ΠΏΡ€ΠΈΠΌΠ΅Ρ€Ρ‹ с числовыми расчётами (Π½Π°ΠΏΡ€ΠΈΠΌΠ΅Ρ€, конвСртация ΠΊΠΎΠΎΡ€Π΄ΠΈΠ½Π°Ρ‚ ΠΈΠ· гСодСзичСской систСмы Π² ENU, ΠΈΠ»ΠΈ ΠΏΡ€ΠΈΠΌΠ΅Ρ€ настройки ΠŸΠ˜Π”-ΠΊΠΎΠ½Ρ‚Ρ€ΠΎΠ»Π»Π΅Ρ€ΠΎΠ² для ΡΡ‚Π°Π±ΠΈΠ»ΡŒΠ½ΠΎΠΉ высоты ΠΈ ΠΏΠΎΠ·ΠΈΡ†ΠΈΠΈ). Π’Π°ΠΊΠΆΠ΅ ΠΌΠΎΠ³Ρƒ ΠΏΡ€Π΅Π΄Π»ΠΎΠΆΠΈΡ‚ΡŒ Π½Π°Π±ΠΎΡ€ Π·Π°Π΄Π°Ρ‡ Π½Π° Π·Π°ΠΊΡ€Π΅ΠΏΠ»Π΅Π½ΠΈΠ΅ ΠΌΠ°Ρ‚Π΅Ρ€ΠΈΠ°Π»Π°.