huangxiaoqiang
2025-11-29 f9e8a2d52fe52fb2389892a46c12d4d262ee9aaf
ÏîÄ¿´úÂë/WCS/WIDESEAWCS_Server/WIDESEAWCS_Tasks/AGV/CommonAGVJob.cs
@@ -1,6 +1,8 @@
using HslCommunication;
using HslCommunication.WebSocket;
using Newtonsoft.Json;
using Newtonsoft.Json.Linq;
using OfficeOpenXml.FormulaParsing.Excel.Functions.Information;
using Quartz;
using System;
using System.Collections.Generic;
@@ -39,41 +41,145 @@
        public Task Execute(IJobExecutionContext context)
        {
            var RelocationTask = _taskRepository.QueryData(x => _taskService.TaskRelocationboundTypes.Contains(x.TaskType) && x.TaskState == (int)TaskRelocationStatusEnum.RelocationNewAGV);
            if (RelocationTask.Count > 0)
            {
                foreach (var item in RelocationTask)
                {
                    AGVSendTask(item);
                    _taskService.UpdateTaskStatusToNext(item.TaskNum);
                }
            }
            #region AGV跨楼层任务
            var AcrossFloorTask = _taskRepository.QueryFirst(x => x.TaskState == (int)TaskAcrossFloorStatusEnum.CarryNew);
            if (AcrossFloorTask != null)
            var AcrossFloorTasks = _taskRepository.QueryData(x => x.TaskState == (int)TaskAcrossFloorStatusEnum.CarryNew);
            if (AcrossFloorTasks.Count() > 0)
            {
                var task = _taskRepository.QueryFirst(x => x.TaskState > (int)TaskAcrossFloorStatusEnum.CarryNew && x.TaskState < (int)TaskAcrossFloorStatusEnum.EndAddressExecuting);
                if(task == null)
                if (task == null)
                {
                    CommonElevator? elevator = Storage.Devices.FirstOrDefault(x => x.DeviceCode == "TSJ1") as CommonElevator;
                    if (elevator != null)
                    Dt_Task? AcrossFloorTask = null;
                    if (AcrossFloorTasks[0].Floor == "2F")
                    {
                        if (elevator.GetValue<ElevatorDBName, short>(ElevatorDBName.Model) == 1)
                        AcrossFloorTask = AcrossFloorTasks.Where(x => x.DoubleTray != 1).OrderBy(x => x.Grade).ToList().FirstOrDefault();
                    }
                    else
                    {
                        AcrossFloorTask = AcrossFloorTasks.Where(x => x.DoubleTray != 1).OrderByDescending(x => x.Grade).ToList().FirstOrDefault();
                    }
                    if (AcrossFloorTask != null)
                    {
                        CommonElevator? elevator = Storage.Devices.FirstOrDefault(x => x.DeviceCode == "TSJ1") as CommonElevator;
                        if (elevator != null)
                        {
                            if (AcrossFloorTask.Floor == "1F")
                            if (elevator.GetValue<ElevatorDBName, short>(ElevatorDBName.Model) == 1)
                            {
                                elevator.SetValue(ElevatorDBName.FlagBit, Convert.ToInt16(1));
                                elevator.SetValue(ElevatorDBName.StartFloor, Convert.ToInt16(1));
                                elevator.SetValue(ElevatorDBName.EdnFloor, Convert.ToInt16(2));
                                Thread.Sleep(1000);
                                elevator.SetValue(ElevatorDBName.StartCommand, Convert.ToInt16(1));
                                _taskService.SendAgvTask("AAA", AcrossFloorTask.TaskNum);
                                AcrossFloorTask.TaskState = (int)TaskAcrossFloorStatusEnum.FirstCarry;
                                _taskRepository.UpdateData(AcrossFloorTask);
                                if (Relocation(AcrossFloorTask))
                                {
                                    if (AcrossFloorTask.Floor == "1F")
                                    {
                                        elevator.SetValue(ElevatorDBName.TaskNum, Convert.ToInt16(AcrossFloorTask.TaskNum));
                                        elevator.SetValue(ElevatorDBName.FlagBit, Convert.ToInt16(1));
                                        elevator.SetValue(ElevatorDBName.StartFloor, Convert.ToInt16(1));
                                        elevator.SetValue(ElevatorDBName.EdnFloor, Convert.ToInt16(2));
                                        Thread.Sleep(1000);
                                        elevator.SetValue(ElevatorDBName.StartCommand, Convert.ToInt16(1));
                                        _taskService.SendAgvTask("AAA", AcrossFloorTask.TaskNum);
                                        _taskService.UpdateTaskStatusToNext(AcrossFloorTask.TaskNum);
                                    }
                                    else
                                    {
                                        elevator.SetValue(ElevatorDBName.TaskNum, Convert.ToInt16(AcrossFloorTask.TaskNum));
                                        elevator.SetValue(ElevatorDBName.FlagBit, Convert.ToInt16(1));
                                        elevator.SetValue(ElevatorDBName.StartFloor, Convert.ToInt16(2));
                                        elevator.SetValue(ElevatorDBName.EdnFloor, Convert.ToInt16(1));
                                        Thread.Sleep(1000);
                                        elevator.SetValue(ElevatorDBName.StartCommand, Convert.ToInt16(1));
                                        _taskService.SendAgvTask("DDD", AcrossFloorTask.TaskNum);
                                        _taskService.UpdateTaskStatusToNext(AcrossFloorTask.TaskNum);
                                    }
                                }
                            }
                            else
                            {
                                elevator.SetValue(ElevatorDBName.FlagBit, Convert.ToInt16(1));
                                elevator.SetValue(ElevatorDBName.StartFloor, Convert.ToInt16(2));
                                elevator.SetValue(ElevatorDBName.EdnFloor, Convert.ToInt16(1));
                                Thread.Sleep(1000);
                                elevator.SetValue(ElevatorDBName.StartCommand, Convert.ToInt16(1));
                        }
                    }
                }
                                _taskService.SendAgvTask("DDD", AcrossFloorTask.TaskNum);
                                AcrossFloorTask.TaskState = (int)TaskAcrossFloorStatusEnum.FirstCarry;
                                _taskRepository.UpdateData(AcrossFloorTask);
                var taskDouble = _taskRepository.QueryData(x => x.TaskState > (int)TaskAcrossFloorStatusEnum.CarryNew && x.TaskState < (int)TaskAcrossFloorStatusEnum.EndAddressExecuting && x.DoubleTray == 1);
                if (taskDouble.Count() < 2)
                {
                    if (taskDouble.Count == 0)
                    {
                        Dt_Task? AcrossFloorTask = null;
                        if (AcrossFloorTasks.Where(x=>x.DoubleTray==1).FirstOrDefault().Floor == "2F")
                        {
                            AcrossFloorTask = AcrossFloorTasks.Where(x => x.DoubleTray == 1).OrderBy(x => x.Grade).ToList().FirstOrDefault();
                        }
                        else
                        {
                            AcrossFloorTask = AcrossFloorTasks.Where(x => x.DoubleTray == 1).OrderByDescending(x => x.Grade).ToList().FirstOrDefault();
                        }
                        if (AcrossFloorTask != null)
                        {
                            CommonElevator? elevator = Storage.Devices.FirstOrDefault(x => x.DeviceCode == "TSJ1") as CommonElevator;
                            if (elevator != null)
                            {
                                if (elevator.GetValue<ElevatorDBName, short>(ElevatorDBName.Model) == 1)
                                {
                                    if (AcrossFloorTask != null)
                                    {
                                        if (Relocation(AcrossFloorTask))
                                        {
                                            if (AcrossFloorTask.Floor == "1F")
                                            {
                                                elevator.SetValue(ElevatorDBName.TaskNum, Convert.ToInt16(AcrossFloorTask.TaskNum));
                                                elevator.SetValue(ElevatorDBName.FlagBit, Convert.ToInt16(2));
                                                elevator.SetValue(ElevatorDBName.StartFloor, Convert.ToInt16(1));
                                                elevator.SetValue(ElevatorDBName.EdnFloor, Convert.ToInt16(2));
                                                Thread.Sleep(1000);
                                                elevator.SetValue(ElevatorDBName.StartCommand, Convert.ToInt16(1));
                                                _taskService.SendAgvTask("AAA", AcrossFloorTask.TaskNum);
                                                _taskService.UpdateTaskStatusToNext(AcrossFloorTask.TaskNum);
                                            }
                                            else
                                            {
                                                elevator.SetValue(ElevatorDBName.TaskNum, Convert.ToInt16(AcrossFloorTask.TaskNum));
                                                elevator.SetValue(ElevatorDBName.FlagBit, Convert.ToInt16(2));
                                                elevator.SetValue(ElevatorDBName.StartFloor, Convert.ToInt16(2));
                                                elevator.SetValue(ElevatorDBName.EdnFloor, Convert.ToInt16(1));
                                                Thread.Sleep(1000);
                                                elevator.SetValue(ElevatorDBName.StartCommand, Convert.ToInt16(1));
                                                _taskService.SendAgvTask("DDD", AcrossFloorTask.TaskNum);
                                                _taskService.UpdateTaskStatusToNext(AcrossFloorTask.TaskNum);
                                            }
                                        }
                                    }
                                }
                            }
                        }
                    }
                    else
                    {
                        var taskSecond = AcrossFloorTasks.Where(x => x.Floor == taskDouble.FirstOrDefault().Floor && x.DoubleTray==1).FirstOrDefault();
                        if (taskSecond != null)
                        {
                            if (Relocation(taskSecond))
                            {
                                if (taskSecond.Floor == "1F")
                                {
                                    _taskService.SendAgvTask("AAA", taskSecond.TaskNum);
                                    _taskService.UpdateTaskStatusToNext(taskSecond.TaskNum);
                                }
                                else
                                {
                                    _taskService.SendAgvTask("DDD", taskSecond.TaskNum);
                                    _taskService.UpdateTaskStatusToNext(taskSecond.TaskNum);
                                }
                            }
                        }
                    }
@@ -82,121 +188,66 @@
            #endregion
            #region AGV同层搬运任务
            var CarryTask = _taskRepository.QueryData(x => x.TaskType == (int)TaskAGVCarryTypeEnum.CarryReloction && x.TaskState == (int)TaskAGVCarryStatusEnum.CarryNew);
            var Carry = _taskRepository.QueryFirst(x => x.TaskState == (int)TaskAGVCarryStatusEnum.CarryNew);
            if (CarryTask .Count>0)
            var Carrys = _taskRepository.QueryData(x => _taskService.TaskAGVCarryboundStates.Contains(x.TaskState) && x.TaskState == (int)TaskAGVCarryStatusEnum.CarryNew);
            if (Carrys.Count>0)
            {
                foreach (var item in CarryTask)
                if (Carrys[0].Floor == "2F")
                {
                    AGVSendTask(item);
                }
            }
            if (Carry != null)
            {
                var task = _taskRepository.QueryFirst(x => x.TaskState > (int)TaskAGVCarryStatusEnum.CarryNew);
                if (task == null)
                {
                    var taskDto = new RequestTaskDto()
                    {
                        Position = Carry.SourceAddress,
                        PalletCode = Carry.PalletCode,
                        TaskNum = Carry.TaskNum
                    };
                    // èŽ·å–WMSip地址
                    var configz = _sys_ConfigService.GetConfigsByCategory(CateGoryConst.CONFIG_SYS_IPAddress);
                    var wmsBasez = configz.Where(x => x.ConfigKey == SysConfigKeyConst.WMSIP_BASE).FirstOrDefault()?.ConfigValue;
                    var requestLocation = configz.Where(x => x.ConfigKey == SysConfigKeyConst.AGVIsNeedRelocation).FirstOrDefault()?.ConfigValue;
                    if (wmsBasez == null || requestLocation == null)
                    {
                        throw new InvalidOperationException("WMS IP æœªé…ç½®");
                    }
                    var wmsIpAddrss = wmsBasez + requestLocation;
                    var result = HttpHelper.PostAsync(wmsIpAddrss, taskDto.ToJsonString()).Result;
                    WebResponseContent content = JsonConvert.DeserializeObject<WebResponseContent>(result);
                    if (!content.Status)
                    {
                        Carry.ExceptionMessage = content.Message;
                        _taskRepository.UpdateData(Carry);
                        return null;
                    }
                    // ååºåˆ—化任务数据
                    var taskDTO = JsonConvert.DeserializeObject<List<WMSTaskDTO>>(content.Data.ToString());
                    bool IsAddTask = false;
                    foreach (var t in taskDTO)
                    {
                        if (t.TaskNum == Carry.TaskNum)
                        {
                            IsAddTask = true;
                            break;
                        }
                        else
                        {
                            IsAddTask = true;
                        }
                    }
                    if (IsAddTask)
                        _taskService.ReceiveWMSTask(taskDTO);
                    var taskNew = _taskRepository.QueryData(x => x.TaskType == (int)TaskAGVCarryTypeEnum.CarryReloction && x.TaskState == (int)TaskAGVCarryStatusEnum.CarryNew);
                    if (taskNew.Count > 0)
                    {
                        if (taskNew[0].Remark == "2")
                        {
                            foreach (var item in taskNew.OrderBy(x => x.Grade).ToList())
                            {
                                AGVSendTask(item);
                            }
                        }
                        else
                        {
                            foreach (var item in taskNew.OrderByDescending(x => x.Grade).ToList())
                            {
                                AGVSendTask(item);
                            }
                        }
                    }
                    var Carry = Carrys.OrderBy(x => x.Grade).ToList().FirstOrDefault();
                    Relocation(Carry);
                    AGVSendTask(Carry);
                    _taskService.UpdateTaskStatusToNext(Carry.TaskNum);
                }
                else
                {
                    var Carry = Carrys.OrderByDescending(x => x.Grade).ToList().FirstOrDefault();
                    Relocation(Carry);
                    AGVSendTask(Carry);
                    _taskService.UpdateTaskStatusToNext(Carry.TaskNum);
                }
            }
            #endregion
            #region 1楼AGV入库任务
            var InTask = _taskRepository.QueryFirst(x => x.TaskState == (int)TaskInStatusEnum.InNew);
            if (InTask != null)
            var InTasks = _taskRepository.QueryData(x => x.TaskState == (int)TaskInStatusEnum.InNew);
            if (InTasks.Count>0)
            {
                var OutTask = _taskRepository.QueryFirst(x => x.TaskState >= (int)TaskOutStatusEnum.OutNew && x.TaskState <(int)TaskOutStatusEnum.AGV_OutExecuting);
                var task = _taskRepository.QueryFirst(x => x.TaskState > (int)TaskInStatusEnum.InNew && x.TaskState < (int)TaskInStatusEnum.SC_InExecuting);
                CommonConveyorLine? conveyorLine = Storage.Devices.FirstOrDefault(x => x.DeviceCode == "1001") as CommonConveyorLine;
                var OutTask = _taskRepository.QueryFirst(x => x.TaskState >= (int)TaskOutStatusEnum.OutNew && x.TaskState < (int)TaskOutStatusEnum.AGV_OutExecuting);
                var task = _taskRepository.QueryFirst(x => x.TaskState > (int)TaskInStatusEnum.InNew && x.TaskState < (int)TaskInStatusEnum.SC_InFinish);
                if (OutTask == null && task == null)
                {
                    CommonConveyorLine? conveyorLine = Storage.Devices.FirstOrDefault(x => x.DeviceCode == "1001") as CommonConveyorLine;
                    if (conveyorLine != null)
                    {
                        bool IsWrite = false;
                        Dt_Task? InTask = InTasks.OrderByDescending(x => x.Grade).ToList().FirstOrDefault();
                        short InteractiveSignal = conveyorLine.GetValue<ConveyorLineDBName, short>(ConveyorLineDBName.InteractiveSignal, "LK001");
                        var taskNum = conveyorLine.GetValue<ConveyorLineDBName, int>(ConveyorLineDBName.ConveyorLineTaskNum, "LK001");
                        var structs = BitConverter.GetBytes(InteractiveSignal).Reverse().ToArray().ToBoolArray();
                        if (structs[0])
                        bool IsWrite = false;
                        {
                            IsWrite = conveyorLine.Communicator.WriteNoRead("DB100.0", 0);
                            Thread.Sleep(1000);
                            IsWrite = conveyorLine.Communicator.WriteNoRead("DB100.0", 9999);
                            if (!IsWrite)
                            if (structs[0] && !structs[1])
                            {
                                return Task.CompletedTask;
                                IsWrite = conveyorLine.Communicator.Write("DB100.0", Convert.ToInt32(0));
                                Thread.Sleep(1000);
                                IsWrite = conveyorLine.Communicator.Write("DB100.0", Convert.ToInt32(9999));
                                if (!IsWrite)
                                {
                                    return Task.CompletedTask;
                                }
                                if (Relocation(InTask))
                                {
                                    _taskService.SendAgvTask("LIFANG", InTask.TaskNum);
                                    _taskService.UpdateTaskStatusToNext(InTask.TaskNum);
                                }
                            }
                            _taskService.SendAgvTask("LIFANG", InTask.TaskNum);
                            _taskService.UpdateTaskStatusToNext(InTask.TaskNum);
                        }
                    }
                }
            }
@@ -205,26 +256,93 @@
            return Task.CompletedTask;
        }
        public void AGVSendTask(Dt_Task task)
        {
            if (task.SourceAddress.Contains("XB001") || task.TargetAddress.Contains("XB001"))
            {
                _taskService.SendAgvTask("cattleCarry1", task.TaskNum);
                task.TaskState = (int)TaskAGVCarryStatusEnum.AGV_CarryExecuting;
                _taskRepository.UpdateData(task);
            }
            else if (task.Floor == "1F")
            {
                _taskService.SendAgvTask("forkAutoTemplate1", task.TaskNum);
                task.TaskState = (int)TaskAGVCarryStatusEnum.AGV_CarryExecuting;
                _taskRepository.UpdateData(task);
            }
            else
            {
                _taskService.SendAgvTask("cattleCarry1", task.TaskNum);
                task.TaskState = (int)TaskAGVCarryStatusEnum.AGV_CarryExecuting;
                _taskRepository.UpdateData(task);
            }
        }
        public bool Relocation(Dt_Task? task)
        {
            var taskDto = new RequestTaskDto()
            {
                Position = task.SourceAddress,
                PalletCode = task.PalletCode,
                TaskNum = task.TaskNum
            };
            // èŽ·å–WMSip地址
            var configz = _sys_ConfigService.GetConfigsByCategory(CateGoryConst.CONFIG_SYS_IPAddress);
            var wmsBasez = configz.Where(x => x.ConfigKey == SysConfigKeyConst.WMSIP_BASE).FirstOrDefault()?.ConfigValue;
            var requestLocation = configz.Where(x => x.ConfigKey == SysConfigKeyConst.AGVIsNeedRelocation).FirstOrDefault()?.ConfigValue;
            if (wmsBasez == null || requestLocation == null)
            {
                throw new InvalidOperationException("WMS IP æœªé…ç½®");
            }
            var wmsIpAddrss = wmsBasez + requestLocation;
            var result = HttpHelper.PostAsync(wmsIpAddrss, taskDto.ToJsonString()).Result;
            WebResponseContent content = JsonConvert.DeserializeObject<WebResponseContent>(result);
            if (!content.Status)
            {
                task.ExceptionMessage = content.Message;
                _taskRepository.UpdateData(task);
                return false;
            }
            // ååºåˆ—化任务数据
            var taskDTO = JsonConvert.DeserializeObject<List<WMSTaskDTO>>(content.Data.ToString());
            bool IsAddTask = false;
            foreach (var t in taskDTO)
            {
                if (t.TaskNum == task.TaskNum)
                {
                    IsAddTask = false;
                    break;
                }
                else
                {
                    IsAddTask = true;
                }
            }
            if (IsAddTask)
                _taskService.ReceiveWMSTask(taskDTO);
            var taskNew = _taskRepository.QueryData(x => _taskService.TaskRelocationboundTypes.Contains(x.TaskType) && x.TaskState == (int)TaskRelocationStatusEnum.RelocationNewAGV);
            if (taskNew.Count > 0)
            {
                if (taskNew[0].Floor == "2F")
                {
                    foreach (var item in taskNew.OrderBy(x => x.Grade).ToList())
                    {
                        AGVSendTask(item);
                        _taskService.UpdateTaskStatusToNext(item.TaskNum);
                    }
                }
                else
                {
                    foreach (var item in taskNew.OrderByDescending(x => x.Grade).ToList())
                    {
                        AGVSendTask(item);
                        _taskService.UpdateTaskStatusToNext(item.TaskNum);
                    }
                }
            }
            return true;
        }
    }
}