ajustes can ethernet para mks

AgroBase/AgroBase/Services/CanServiceEthernet.cs

@@ -53,6 +53,9 @@ namespace AgroBase.Services
         private readonly ConcurrentDictionary<uint, bool> _roteadoresRegistrados = new ConcurrentDictionary<uint, bool>();
         private readonly List<CanMessage> MensagensPendentes = new List<CanMessage>();
 
+        private readonly ConcurrentDictionary<uint, DateTime> _cooldownPorId = new ConcurrentDictionary<uint, DateTime>();
+        private static readonly TimeSpan COOLDOWN_MKS = TimeSpan.FromMilliseconds(20);
+
         private uint? _ultimoIdEnviado = null;
         private bool DebugMode = false;
 
@@ -302,6 +305,21 @@ namespace AgroBase.Services
             return baseLista.Where(x => x.IdTx == proximoId).OrderBy(x => x.Momento).FirstOrDefault();
         }
 
+        private bool PodeEnviarAgora(CanMessage m)
+        {
+            if (m.Dispositivo != T_Code.Mks)
+                return true;
+
+            var now = DateTime.UtcNow;
+            var due = _cooldownPorId.GetOrAdd(m.IdTx, DateTime.MinValue);
+
+            if (now < due)
+                return false;
+
+            _cooldownPorId[m.IdTx] = now + COOLDOWN_MKS;
+            return true;
+        }
+
         private async Task EnviarCAN()
         {
             if (!IsConnected) return;
@@ -316,6 +334,12 @@ namespace AgroBase.Services
                 var msg = ObterProximaMensagem();
                 if (msg == null) break;
 
+                if (sent > 0 && msg.Dispositivo == T_Code.Mks)
+                    break;
+
+                if (!PodeEnviarAgora(msg))
+                    break;
+
                 byte[] packet = CriarPacoteUsrStandard(msg);
 
                 if (!EnviarPacote(packet, msg.IdTx))
@@ -552,12 +576,28 @@ namespace AgroBase.Services
                 lock (_LockMensagens)
                 {
                     mensagem = MensagensPendentes.FirstOrDefault(x =>
-                        x.Enviado &&
+                    {
-                        !x.Respondido &&
+                        if (!x.Enviado) return false;
-                        x.Dispositivo == dispositivo &&
+                        if (x.Respondido) return false;
-                        x.IdRx == id &&
+                        if (x.Dispositivo != dispositivo) return false;
-                        x.DataTx != null &&
+                        if (x.IdRx != id) return false;
-                        (db || data.Length < 2 || x.DataTx.Length < 2 || x.DataTx[1] == data[1]));
+                        if (x.DataTx == null || x.DataTx.Length == 0) return false;
+
+                        if (db)
+                            return true;
+
+                        // MKS: a resposta deve casar pelo function code.
+                        // TX: [code, ..., crc]
+                        // RX: [code, ..., crc]
+                        if (x.Dispositivo == T_Code.Mks)
+                            return data.Length > 0 && x.funcCodeRx == data[0];
+
+                        // Demais protocolos antigos
+                        if (data.Length < 2 || x.DataTx.Length < 2)
+                            return true;
+
+                        return x.DataTx[1] == data[1];
+                    });
                 }
 
                 if (mensagem == null)
@@ -565,6 +605,7 @@ namespace AgroBase.Services
                     mensagem = new CanMessage
                     {
                         Dispositivo = dispositivo,
+                        IdTx = id,
                         IdRx = id,
                         funcCodeRx = fCodeRx,
                         DataRx = data,