限制任务请求队列中只能有一个请求

DL.StandardRobots/Robots/StandardRobot.cs

@@ -157,6 +157,7 @@ namespace DL.StandardRobot
                 request.Values = new int[] {(int)GetUInt16(byte4.ByteH1, byte4.ByteH2), (int)GetUInt16(byte4.ByteL1, byte4.ByteL2) };
                 request.Values = new int[] {(int)GetUInt16(byte4.ByteH1, byte4.ByteH2), (int)GetUInt16(byte4.ByteL1, byte4.ByteL2) };
                 _client.AddRequest(request);
                 _client.AddRequest(request);
                 missionState.MissionId = (uint)id;
                 missionState.MissionId = (uint)id;
+                LogUtil.Info($"AddMission missionId:{id}");
                 MissionSateChanged?.Invoke(missionState);
                 MissionSateChanged?.Invoke(missionState);
                 return true;
                 return true;
             }
             }

DL.StandardRobots/TCP/ModbusTCPMaster.cs

@@ -328,6 +328,11 @@ namespace DL.Com.TCP
         /// <param name="request"></param>
         /// <param name="request"></param>
         void EnRequestQueue(RequestInfo request)
         void EnRequestQueue(RequestInfo request)
         {
         {
+            if(requestInfos.Count>0)
+            {
+                LogUtil.Info($"The count of request queue is {requestInfos.Count},clear the queue:{JsonHelper.SerializeObject(requestInfos)}");
+                requestInfos = new ConcurrentQueue<RequestInfo>();
+            }
             requestInfos.Enqueue(request);
             requestInfos.Enqueue(request);
             if (!GetFunction(request.FunCode).Equals(RegisterFunction.Read))
             if (!GetFunction(request.FunCode).Equals(RegisterFunction.Read))
                 LogUtil.Info($"Enqueue Request {request}");
                 LogUtil.Info($"Enqueue Request {request}");