chengsc
2025-04-28 25f52fdb9a195ab651bff2ebb318119ce7f1f633
Admin.NET/WCS.Application/PLC/PLCTaskAction.cs
@@ -2,13 +2,18 @@
using DocumentFormat.OpenXml.Bibliography;
using DocumentFormat.OpenXml.Drawing;
using DocumentFormat.OpenXml.Drawing.Charts;
using Elastic.Clients.Elasticsearch.Snapshot;
using Furion.Logging;
using Microsoft.AspNetCore.SignalR;
using NewLife.Serialization;
using OfficeOpenXml.FormulaParsing.Excel.Functions.Logical;
using OfficeOpenXml.FormulaParsing.Excel.Functions.Text;
using OnceMi.AspNetCore.OSS;
using System;
using System.Drawing.Drawing2D;
using System.Net.NetworkInformation;
using WCS.Application.Entity;
using WCS.Application.Util;
using static SKIT.FlurlHttpClient.Wechat.Api.Models.CgibinExpressIntracityUpdateStoreRequest.Types;
//using WCS.Application.Util;
@@ -35,6 +40,7 @@
    private static readonly ISqlSugarClient _db = SqlSugarSetup.ITenant.GetConnectionScope(SqlSugarConst.MainConfigId);
    private static readonly SysCacheService sysCacheService = App.GetRequiredService<SysCacheService>();
    private static readonly SysConfigService _sysConfigService = App.GetService<SysConfigService>();
    private static readonly WcsTaskService _taskService = App.GetService<WcsTaskService>();
    private static List<WcsPlc> listPlc = new List<WcsPlc>();
    private static List<WcsDevice> listPlcDevice = new List<WcsDevice>();
@@ -84,7 +90,7 @@
    /// <summary>
    /// 初始化PLC连接
    /// </summary>
    public static void Init()
    public static void Init()
    {
        cts.Cancel();
        listPlc = _db.Queryable<WcsPlc>()
@@ -137,6 +143,7 @@
            StartRead();
            ConnectionStatus();
            StartWatchAlarm();
            AssignTasks();
            //StartWatchPosition();
        }
    }
@@ -202,15 +209,15 @@
                                        var (result, value) = modPlcUtil.GetPlcDBValue(modDevice.PosType, modDevice.DbNumber, modDevice.PlcPos);
                                        if (result.IsSucceed)
                                        {
                                            //如果是穿梭车,这里发送心跳
                                            if (modPlc.Type == PLCTypeEnum.ShuttleCar)
                                            {
                                                var modHeart = listPlcPosition.Where(s => s.DeviceId == modDevice.Id && s.Text == "心跳").FirstOrDefault();
                                                if (modHeart != null)
                                                {
                                                    modPlcUtil.SetPlcDBValue(modHeart.PosType, modHeart.PlcPos, "1");
                                                }
                                            }
                                            ////如果是穿梭车,这里发送心跳
                                            //if (modPlc.Type == PLCTypeEnum.ShuttleCar)
                                            //{
                                            //    var modHeart = listPlcPosition.Where(s => s.DeviceId == modDevice.Id && s.Text == "心跳").FirstOrDefault();
                                            //    if (modHeart != null)
                                            //    {
                                            //        modPlcUtil.SetPlcDBValue(modHeart.PosType, modHeart.PlcPos, "1");
                                            //    }
                                            //}
                                            //无流程跳出
                                            if (Convert.ToInt32(value) == 0)
                                                continue;
@@ -258,11 +265,22 @@
                                        var (result, value) = modbusUtil.GetDBValue(modDevice.PosType, modDevice.PlcPos);
                                        if (result.IsSucceed)
                                        {
                                            //如果是穿梭车,这里发送心跳
                                            if (modPlc.Type == PLCTypeEnum.ShuttleCar)
                                            {
                                                var modHeart = listPlcPosition.Where(s => s.DeviceId == modDevice.Id && s.Text == "心跳").FirstOrDefault();
                                                if (modHeart != null)
                                                {
                                                    modbusUtil.SetDBValue(modHeart.PosType, modHeart.PlcPos, "1");
                                                }
                                            }
                                            //无流程跳出
                                            if (value == 0)
                                                continue;
                                            var dto = modDevice.Adapt<WcsDeviceDto>();
                                            dto.Value = value;
                                            dto.PlcIdIP = modPlc.IP;
                                            dto.Type = _modplc.Type;
                                            dto.modbusUtil = modbusUtil;
                                            dto.listStation = listPlcPosition.Where(s => s.DeviceId == modDevice.Id).ToList();
@@ -320,7 +338,7 @@
                        Thread.Sleep(1000);
                        Thread.Sleep(3000);
                    }
                    catch (OperationCanceledException)
                    {
@@ -334,6 +352,177 @@
            }, cts.Token);
        }
    }
    /// <summary>
    /// 四向车任务分配
    /// </summary>
    private static void AssignTasks()
    {
        Task.Run(() =>
        {
            while (true)
            {
                Console.WriteLine("开启四向车任务自分配");
                //取消线程 关闭PLC连接
                if (cts.Token.IsCancellationRequested)
                {
                    foreach (var modModBusUtil in listModbusUtil)
                    {
                        if (modModBusUtil != null && modModBusUtil.Connected)
                            modModBusUtil.Close();
                    }
                    break;
                }
                try
                {
                    // 获取密集库未执行任务 根据创建时间排序
                    var waitTask = _db.Queryable<WcsTask>().Where(s => s.IsDelete == false && s.Status == TaskStatusEnum.Wait && s.Type == PLCTypeEnum.ShuttleCar).OrderBy(s => s.CreateTime).First();
                    if (waitTask == null)
                    {
                        continue;
                    }
                    //01010101: 01排 01列 01层 01深度-此项目不做判断
                    var taskpai = int.Parse(waitTask.StartLocate.Substring(0, 2));
                    var tasklie = int.Parse(waitTask.StartLocate.Substring(2, 2));
                    var taskceng = int.Parse(waitTask.StartLocate.Substring(4, 2));
                    #region 获取当前任务所在层所有空闲小车
                    // 获取有任务的小车编号
                    var taskCarList = _db.Queryable<WcsCarTasks>().Where(m => m.IsDelete == false && m.Status == TaskStatusEnum.Wait).Select(m => m.CarNo).Distinct().ToList();
                    // 获取当前任务所在层所有空闲小车(根据小车任务表是否有任务和小车状态共同判断小车是否空闲)
                    var kXCarList = new List<CarInfo>();
                    var carErr = false;//小车是否有失联的
                    foreach (var modbusUtil in listModbusUtil)
                    {
                        //如果小车有未执行的任务,跳出
                        if (taskCarList.Contains(modbusUtil.PlcIP))
                        {
                            continue;
                        }
                        //获取小车的WcsDevice信息
                        var listDevice = listPlcDevice.Where(s => s.PlcId == modbusUtil.PlcId && s.DeviceType == DeviceTypeEnum.Business).ToList();
                        //循环读设备
                        foreach (var modDevice in listDevice)
                        {
                            var (result, value) = modbusUtil.GetDBValue(modDevice.PosType, modDevice.PlcPos);
                            if (result.IsSucceed)
                            {
                                //获取工位WCSPLCPosition信息
                                var plcPosition = listPlcPosition.Where(s => s.DeviceId == modDevice.Id).ToList();
                                //小车空闲加入集合
                                if (value == 1)
                                {
                                    var modStationX = plcPosition.FirstOrDefault(s => s.Text == "四向车位置(X)");
                                    var (resultx, valuex) = modbusUtil.GetDBValue(modStationX.PosType, modStationX.PlcPos);
                                    var modStationY = plcPosition.FirstOrDefault(s => s.Text == "四向车位置(Y)");
                                    var (resulty, valuey) = modbusUtil.GetDBValue(modStationY.PosType, modStationY.PlcPos);
                                    var modStationZ = plcPosition.FirstOrDefault(s => s.Text == "四向车位置(Z)");
                                    var (resultz, valuez) = modbusUtil.GetDBValue(modStationZ.PosType, modStationZ.PlcPos);
                                    //小车当前层
                                    var carZ = (int)valuez;
                                    //任务层与小车层相同
                                    if (taskceng == carZ)
                                    {
                                        if (!kXCarList.Any(m => m.CarPlcIp == modbusUtil.PlcIP))
                                        {
                                            var carVal = ((int)valuex).ToString().PadLeft(2, '0') + ((int)valuey).ToString().PadLeft(2, '0') + ((int)valuez).ToString().PadLeft(2, '0');
                                            //小车到取货储位路径
                                            var d = FourWayCarUtil.GetCarPath(carVal, waitTask.StartLocate);
                                            kXCarList.Add(new CarInfo()
                                            {
                                                CarPlcIp = modbusUtil.PlcIP,
                                                X = (int)valuex,
                                                Y = (int)valuey,
                                                Z = (int)valuez,
                                                Level = d.Count,
                                            });
                                        }
                                    }
                                }
                            }
                            else
                            {
                                Console.WriteLine($"读取四向车{modbusUtil.PlcIP}状态失败");
                                carErr = true;
                                break;//有一个小车读取失败跳出方法,暂缓分配,防止同层小车关机或失联导致阻挡路径
                            }
                        }
                        //有小车失联,不分配任务
                        if (carErr)
                        {
                            kXCarList.Clear();//清楚空车记录
                            break;
                        }
                    }
                    #endregion
                    // 获取适合执行当前任务的小车 生成路径(需考虑小车阻阻挡)
                    var assignCar = kXCarList.OrderBy(m => m.Level).FirstOrDefault();
                    if (assignCar == null)
                    {
                        continue;//没有空闲小车
                    }
                    if (assignCar.Level != 0)
                    {
                        //判断小车位置是否与任务的起始储位相同,不相同:获取小车到取货储位路径
                        var carLocate = assignCar.X.ToString().PadLeft(2, '0')+assignCar.Y.ToString().PadLeft(2, '0')+ assignCar.Z.ToString().PadLeft(2, '0');
                        //获取小车去取货储位任务路径
                        var data1 = FourWayCarUtil.GetCarPath(carLocate, waitTask.StartLocate);
                        var datas1 = FourWayCarUtil.GetCarPathUp(data1, 0);
                        if (datas1 == null)
                        {
                            continue;
                        }
                        else
                        {
                            var bl = FourWayCarUtil.AddCarTask(datas1, kXCarList, assignCar, waitTask,0);
                            //分配错误,删除分配信息
                            if (!bl)
                            {
                                var carTask = _db.Queryable<WcsCarTasks>().Where(m => m.IsDelete == false && m.TaskNo == waitTask.TaskNo).ToList();
                                _db.Deleteable(carTask).ExecuteCommand();
                            }
                        }
                    }
                    //获取小车去放货储位任务路径
                    var data2 = FourWayCarUtil.GetCarPath(waitTask.StartLocate, waitTask.EndLocate, "1");
                    var datas2 = FourWayCarUtil.GetCarPathUp(data2, 1);
                    if (datas2 == null)
                    {
                        continue;
                    }
                    else
                    {
                        var bl = FourWayCarUtil.AddCarTask(datas2,kXCarList,assignCar,waitTask,1);
                        //分配错误,删除分配信息
                        if (!bl)
                        {
                            waitTask.Status = TaskStatusEnum.Wait;
                            _db.Updateable(waitTask).ExecuteCommand();
                            var carTask = _db.Queryable<WcsCarTasks>().Where(m=>m.IsDelete == false && m.TaskNo == waitTask.TaskNo).ToList();
                            _db.Deleteable(carTask).ExecuteCommand();
                        }
                    }
                    Thread.Sleep(3000);
                }
                catch (Exception ex)
                {
                    Log.Error("任务分配发生异常", ex);
                }
            }
        },cts.Token);
    }
    /// <summary>
    /// 连接状态线程
@@ -692,6 +881,10 @@
            }
        });
    }
    /// <summary>
    /// 修改位置信息
    /// </summary>
    /// <param name="modInfo"></param>
    private static void UpdatePosition(PlcPositionInfo modInfo)
    {
        var modTemp = listPositionInfo.FirstOrDefault(s => s.StationNum == modInfo.StationNum && modInfo.Type == s.Type);