测试模组增加日志打印

Rs.SkyLine/Flow/TakeTrayFlow.cs

@@ -60,6 +60,7 @@ namespace Rs.MotionPlat.Flow
                 return intance;
             }
         }
+        string logInfo = "";
         Stopwatch stopwatch = new Stopwatch();
         ETakeTrayFlowStep step = ETakeTrayFlowStep.等待命令;
         private EStockType m_fromTray = EStockType.Empty2;
@@ -87,7 +88,6 @@ namespace Rs.MotionPlat.Flow
                 case ETakeTrayFlowStep.到取料盘上方:
                     double centerX = SysConfigParam.GetValue<double>($"Tray{m_fromTray.ToString()}CenterX");
                     double centerY = SysConfigParam.GetValue<double>($"Tray{m_fromTray.ToString()}CenterY");
-
                     double cameraCenterX = SysConfigParam.GetValue<double>("ClampCenter2UpCameraCenterX");
                     double cameraCenterY = SysConfigParam.GetValue<double>("ClampCenter2UpCameraCenterY");
                     Motion.ErrorCode errCode = AxisControl.LoadX.MovePos(centerX + cameraCenterX, GlobalVar.TakeTraySpeed);
@@ -96,8 +96,17 @@ namespace Rs.MotionPlat.Flow
                         errCode = AxisControl.LoadY.MovePos(centerY + cameraCenterY, GlobalVar.TakeTraySpeed);
                         if (errCode == Motion.ErrorCode.Ok)
                         {
+                            logInfo = $"准备运动{m_fromTray}料仓到取料盘位上方";
                             step = ETakeTrayFlowStep.等待到取料盘上方;
                         }
+                        else
+                        {
+                            MessageQueue.Instance.Warn($"LoadY move fail ret={errCode}");
+                        }
+                    }
+                    else
+                    {
+                        MessageQueue.Instance.Warn($"LoadX move fail ret={errCode}");
                     }
                     break;
                 case ETakeTrayFlowStep.等待到取料盘上方: