gogacoder/bas
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Обновить points_2022.cpp

Browse Source
This commit is contained in:
Goga Coder
2025-04-04 12:42:19 +07:00
parent 39d5b8d162
commit 32b5ee3cde
1 changed files with 2 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
points_2022.cpp
View File

@@ -62,16 +62,12 @@ SignalBody Task4_solution::Task8_in_the_loop(Skywalker2015PacketTelemetry, →
, → , →
необходимости необходимости
_Point_Index = GetNowPointIndex(a_telemetry.L, a_telemetry.Z, a_telemetry.H); _Point_Index = GetNowPointIndex(a_telemetry.L, a_telemetry.Z, a_telemetry.H);
// Через координаты путевой точки и текущего местоположения БЛА найти // Через координаты путевой точки и текущего местоположения БЛА найти, направление на путевую точку(пеленг)
, →
направление на путевую точку(пеленг)
_ans.Gamma_direct = PointsFlyGam(_Point_Index, a_telemetry.L, a_telemetry.Z, , → _ans.Gamma_direct = PointsFlyGam(_Point_Index, a_telemetry.L, a_telemetry.Z, , →
a_telemetry.Psi); a_telemetry.Psi);
// Рассчитать необходимое изменение угла курса // Рассчитать необходимое изменение угла курса
// Рассчитать требуемый угол крена (для регулирования курса) // Рассчитать требуемый угол крена (для регулирования курса)
// На основе текущей высоты БЛА и заданной высоты путевой точки рассчитать // На основе текущей высоты БЛА и заданной высоты путевой точки рассчитать, необходимое изменение высоты
, →
необходимое изменение высоты
_ans.Tang_direct = PointsFlyTan(a_telemetry.H, a_telemetry.Vy1, , → _ans.Tang_direct = PointsFlyTan(a_telemetry.H, a_telemetry.Vy1, , →
_Point_Index); _Point_Index);
// Рассчитать требуемый угол тангажа (для регулирования высоты) // Рассчитать требуемый угол тангажа (для регулирования высоты)