From 3e4973a129fbeafaf19d5ea90452eb51d220fcc4 Mon Sep 17 00:00:00 2001 From: Sergey Sklyarov Date: Thu, 19 Jun 2025 01:07:53 +0300 Subject: [PATCH] Update Drone.cs --- DroneSimulator/Drone.cs | 32 ++++++++++++++++++++------------ 1 file changed, 20 insertions(+), 12 deletions(-) diff --git a/DroneSimulator/Drone.cs b/DroneSimulator/Drone.cs index f5b3186..cee859c 100644 --- a/DroneSimulator/Drone.cs +++ b/DroneSimulator/Drone.cs @@ -241,32 +241,40 @@ namespace DroneSimulator if (Area.Poisition.Freeze.Y) { SpdXYZ.Y = 0; PosXYZ.Y = 0; } if (Area.Poisition.Freeze.Z) { SpdXYZ.Z = 0; PosXYZ.Z = 5; } - if (PosXYZ.Z < 0) + /*if (PosXYZ.Z < 0) { SpdPRY = Vector3.Zero; SpdXYZ.X = 0; SpdXYZ.Y = 0; Quat = Quaternion.Identity; } - else Rotate(SpdPRY.X * time, SpdPRY.Y * time, SpdPRY.Z * time); + else */ + Rotate(SpdPRY.X * time, SpdPRY.Y * time, SpdPRY.Z * time); Vector4 ori = GetOrientation(); Orientation = ori; - if (PosXYZ.Z < 0) + if(PosXYZ.Z < 0) + { + PosXYZ.Z = 0; + SpdXYZ.Z = 0; + LaserRange = 0; + } + + /*if (PosXYZ.Z < 0) { PosXYZ.Z = 0; - /*if (SpdXYZ.Z < -5) - { - Active = false; // Сильно ударился о землю - }*/ + //if (SpdXYZ.Z < -5) + //{ + // Active = false; // Сильно ударился о землю + //} - /*if (MathF.Abs(ori.X) > 20 || MathF.Abs(ori.Y) > 20) - { - Active = false; // Повредил винты при посадке - }*/ + //if (MathF.Abs(ori.X) > 20 || MathF.Abs(ori.Y) > 20) + //{ + // Active = false; // Повредил винты при посадке + //} SpdXYZ.Z = 0; @@ -274,7 +282,7 @@ namespace DroneSimulator Gyr = Vector3.Zero; LaserRange = 0; } - else + else*/ { if (ori.W < 0) {