料盘高度归类算法修改

DeviceLibrary/theMachine/MainMachine_String.cs

@@ -9,6 +9,7 @@ using System.Linq;
 using System.Text;
 using System.Threading;
 using System.Threading.Tasks;
+using System.Windows.Forms;
 
 namespace DeviceLibrary
 {
@@ -385,13 +386,13 @@ namespace DeviceLibrary
                     StringMoveInfo.NextMoveStep(MoveStep.StringReelPut_05);
                     var heightcheck = (LastOutDownPosition - Batch_Axis.GetAclPosition()) / Config.Batch_PoToMM;
                     StringMoveInfo.log($"LastOutDownPosition={LastOutDownPosition},CurrentPosition={Batch_Axis.GetAclPosition()},heightcheck={heightcheck}");
-                    int height = StringMoveInfo.MoveParam.PlateH+3;
+                    int height = StringMoveInfo.MoveParam.PlateH + 3;
                     if (heightcheck <= 5)
                     {
                         Msg.add(crc.GetString(L.outstore_abnormal_reel, "出库时料盘未成功放入料串,请检查"), MsgLevel.alarm);
                         RobotManage.UserPause(crc.GetString(L.outstore_abnormal_reel, "出库时料盘未成功放入料串,请检查"));
                     }
-                    else if((heightcheck < height - 3) || (heightcheck > height + 3))
+                    else if ((heightcheck < height - 3) || (heightcheck > height + 3))
                     {
                         Msg.add(crc.GetString(L.outstore_abnormal_reel, "出库时料盘未成功放入料串,请检查"), MsgLevel.alarm);
                         RobotManage.UserPause(crc.GetString(L.outstore_abnormal_reel, "出库时料盘未成功放入料串,请检查"));
@@ -599,13 +600,14 @@ namespace DeviceLibrary
             else
             {
                 List<int> heightList = new List<int> { 8, 12, 16, 24, 32, 44, 56 };
-                //heightList = (from m in heightList orderby m descending select m).ToList<int>();
-                //float minCha = height;
+                float minCha = float.MaxValue;
                 foreach (int h in heightList)
                 {
-                    if (height > h)
+                    float curCha = Math.Abs(height - h);
+                    if (curCha < minCha)
                     {
                         LastHeight = h;
+                        minCha = curCha;
                     }
                 }
             }