Добавлен сервер для отправки телеметрии

2025-07-05 08:27:19 +11:00
parent 15d4fa5011
commit e5d8a9c507
13 changed files with 2347 additions and 736 deletions
--- a/DroneClient/Models/MonitorContainer.cs
+++ b/DroneClient/Models/MonitorContainer.cs
@ -0,0 +1,126 @@
+using System;
+using System.Collections.Generic;
+using System.Linq;
+using System.Text;
+using System.Threading.Tasks;
+using TelemetryIO;
+
+namespace DroneClient.Models
+{
+    public class monitorItem
+    {
+        public int slotNo = 0;
+        public int offset = 0;
+        public int len = 0;
+        public int id = 0;
+
+        public monitorItem()
+        {
+            
+        }
+        public monitorItem(int slotNo, int offset, int len, int id)
+        {
+            this.slotNo = slotNo;
+            this.offset = offset;
+            this.len = len;
+            this.id = id;
+        }
+    }
+
+    public class MonitorContainer
+    {
+        public const int monitorMaxFill = 32;
+        public int monitorFillLevel = 0;
+        public monitorItem[] monitorItems = new monitorItem[monitorMaxFill];
+        public int isMonitor = 0;
+        private static volatile MonitorContainer instance;
+        private static readonly object _lock = new object();
+
+        public static MonitorContainer Instance
+        {
+            get
+            {
+                if (instance == null)
+                {
+                    lock (_lock)
+                    {
+                        if (instance == null)
+                        {
+                            instance = new MonitorContainer();
+                        }
+                    }
+                }
+                return instance;
+            }
+
+        }
+
+        private MonitorContainer()
+        {
+            for (int i = 0; i < monitorMaxFill; i++)
+            {
+                monitorItems[i] = new monitorItem();
+            }
+        }
+
+        public void resetMonitorContainer()
+        {
+            for (int i = 0; i < monitorMaxFill; i++)
+            {
+                monitorItems[i] = new monitorItem();
+            }
+        }
+
+        public int monitorPut(int slot, int offset, int len)
+        {
+            int ret_id = 0;
+            if (monitorFillLevel < monitorMaxFill)
+            {
+                monitorItems[monitorFillLevel].slotNo = slot;
+                monitorItems[monitorFillLevel].offset = offset;
+                monitorItems[monitorFillLevel].len = len;
+                monitorItems[monitorFillLevel].id = (slot << 8) + offset;
+                ret_id = monitorItems[monitorFillLevel].id;
+                monitorFillLevel++;
+                isMonitor = 1;
+            }
+
+            return ret_id;
+        }
+
+        public int monitorRemove(int id)
+        {
+            int match = 0;
+            int ret_id = 0;
+            for (int i = 0; i < monitorMaxFill; i++)
+            {
+                if (monitorItems[i].id == id)
+                {
+                    match = 1;
+                    if (monitorFillLevel > 0) monitorFillLevel--;
+                    ret_id = id;
+                }
+
+                if (match > 0)
+                {
+                    if (monitorItems[i].len == 0) return ret_id;
+                    if (i < 31)
+                    {
+                        monitorItems[i].id = monitorItems[i + 1].id;
+                        monitorItems[i].offset = monitorItems[i + 1].offset;
+                        monitorItems[i].slotNo = monitorItems[i + 1].slotNo;
+                        monitorItems[i].len = monitorItems[i + 1].len;
+                    }
+                    else
+                    {
+                        monitorItems[i].id = 0;
+                        monitorItems[i].offset = 0;
+                        monitorItems[i].slotNo = 0;
+                        monitorItems[i].len = 0;
+                    }
+                }
+            }
+            return ret_id;
+        }
+    }
+}