wangxinhui
2026-01-12 ded9c653b4bd5f45cb23124068687135c29e6915
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
using Autofac.Core;
using Microsoft.AspNetCore.Components.Routing;
using Newtonsoft.Json;
using OfficeOpenXml.FormulaParsing.Excel.Functions.Math;
using Quartz;
using System;
using System.Collections.Generic;
using System.IdentityModel.Tokens.Jwt;
using System.Linq;
using System.Reflection.Metadata;
using System.Text;
using System.Threading.Tasks;
using WIDESEAWCS_Common;
using WIDESEAWCS_Common.Helper;
using WIDESEAWCS_Common.TaskEnum;
using WIDESEAWCS_Communicator;
using WIDESEAWCS_Core;
using WIDESEAWCS_Core.BaseServices;
using WIDESEAWCS_Core.Helper;
using WIDESEAWCS_IBasicInfoRepository;
using WIDESEAWCS_IPackInfoRepository;
using WIDESEAWCS_ITaskInfoRepository;
using WIDESEAWCS_ITaskInfoService;
using WIDESEAWCS_Model.Models;
using WIDESEAWCS_QuartzJob;
using WIDESEAWCS_QuartzJob.ConveyorLine.Enum;
using WIDESEAWCS_QuartzJob.DTO;
using WIDESEAWCS_QuartzJob.Models;
using WIDESEAWCS_QuartzJob.Repository;
using WIDESEAWCS_QuartzJob.Service;
using WIDESEAWCS_TaskInfoRepository;
using WIDESEAWCS_Tasks.ConveyorLineJob;
using WIDESEAWCS_Tasks.DBNames;
using ICacheService = WIDESEAWCS_Core.Caches.ICacheService;
 
namespace WIDESEAWCS_Tasks
{
    [DisallowConcurrentExecution]
    public class MDJob_CP : JobBase, IJob
    {
        private readonly ICacheService _cacheService;
        private readonly IStationMangerRepository _stationMangerRepository;
        private readonly IPackaxisRepository _packaxisRepository;
        private readonly IPackaxisTaskRepository _packaxisTaskRepository;
        private readonly IPackaxisTaskService _packaxisTaskService;
        private readonly IStationPackInfoRepository _stationPackInfoRepository;
        private readonly List<Dt_WarehouseDevice> warehouseDevices;
 
        public MDJob_CP(ICacheService cacheService, IStationMangerRepository stationMangerRepository,  IPackaxisRepository packaxisRepository, IPackaxisTaskRepository packaxisTaskRepository,IPackaxisTaskService packaxisTaskService, IStationPackInfoRepository stationPackInfoRepository)
        {
            _cacheService = cacheService;
            _stationMangerRepository = stationMangerRepository;
            _packaxisRepository = packaxisRepository;
 
            string? warehouseDevicesStr = _cacheService.Get<string>(nameof(Dt_WarehouseDevice));
            if (!string.IsNullOrEmpty(warehouseDevicesStr))
            {
                warehouseDevices = JsonConvert.DeserializeObject<List<Dt_WarehouseDevice>>(warehouseDevicesStr) ?? new List<Dt_WarehouseDevice>();
            }
            else
            {
                warehouseDevices = new List<Dt_WarehouseDevice>();
            }
            _packaxisTaskRepository = packaxisTaskRepository;
            _packaxisTaskService = packaxisTaskService;
            _stationPackInfoRepository = stationPackInfoRepository;
        }
 
        public Task Execute(IJobExecutionContext context)
        {
            try
            {
                bool flag = context.JobDetail.JobDataMap.TryGetValue("JobParams", out object? value);
                if (flag && value != null)
                {
                    OtherDevice device = (OtherDevice)value;
                    List<Dt_StationManger> stationMangers = _stationMangerRepository.QueryData(x => x.StackerCraneCode == device.DeviceCode && x.StationType == StationTypeEnum.StationType_InStartAndOutEnd.ObjToInt() && x.IsOccupied == 0);
                    //获取协议
                    DeviceProDTO? deviceProRead = device.DeviceProDTOs.Where(x => x.DeviceChildCode == device.DeviceCode && x.DeviceProParamType == nameof(R_MDDB)).OrderBy(x => x.DeviceProOffset).FirstOrDefault();
                    DeviceProDTO? deviceProWrite = device.DeviceProDTOs.Where(x => x.DeviceChildCode == device.DeviceCode && x.DeviceProParamType == nameof(W_MDDB)).OrderBy(x => x.DeviceProOffset).FirstOrDefault();
                    if (deviceProRead != null && deviceProWrite != null)
                    {
                        foreach (var item in stationMangers)
                        {
 
                            short Allow = device.GetValue<R_MDDB, short>(R_MDDB.R_MDAllow, item.StackerCraneCode);
                            #region 读取工位状态
                            short R_MDStatus1 = device.GetValue<R_MDDB, short>(R_MDDB.R_MDStatus1, item.StackerCraneCode);
                            short R_MDStatus2 = device.GetValue<R_MDDB, short>(R_MDDB.R_MDStatus2, item.StackerCraneCode);
                            short R_MDStatus3 = device.GetValue<R_MDDB, short>(R_MDDB.R_MDStatus3, item.StackerCraneCode);
                            short R_MDStatus4 = device.GetValue<R_MDDB, short>(R_MDDB.R_MDStatus4, item.StackerCraneCode);
                            short ReceiveDoneState = device.GetValue<W_MDDB, short>(W_MDDB.W_MDReceiveDone, item.StackerCraneCode);
                            #endregion
                            //码垛状态
                            short PackState = device.GetValue<R_MDDB, short>(GetPackStateEnum(item.StackerCraneStationCode), item.StackerCraneCode);
                            //码垛数量
                            short PackNum = device.GetValue<R_MDDB, short>(GetPackNumEnum(item.StackerCraneStationCode), item.StackerCraneCode);
                            if ((R_MDStatus1 == 1 || R_MDStatus2 == 1 || R_MDStatus3 == 1 || R_MDStatus4 == 1) && Allow == 4)
                            {
                                Thread.Sleep(200);
                                if (ReceiveDoneState != 0)
                                {
                                    device.Communicator.Write<short>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == W_MDDB.W_MDReceiveDone.ToString()).DeviceProDataBlock, 0);
                                    WriteInfo(item.StackerCraneCode, $"{item.StackerCraneCode}工位任务下发标识值为:{ReceiveDoneState},机器人读取状态为:{Allow},1工位{R_MDStatus1},2工位{R_MDStatus2},3工位{R_MDStatus3},4工位{R_MDStatus4},码垛清除下发标识信号");
                                }
                                continue;
                            }
                            if (PackState == 2)
                            {
                                Thread.Sleep(200);
                                device.Communicator.Write<float>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == GetPackSendEnum(item.StackerCraneStationCode).ToString()).DeviceProDataBlock, 0);
                                WriteInfo(item.StationName, $"{item.StationName}清除工位结托信号");
                                continue;
                            }
                            //获取当前工位码垛执行中数据
                            Dt_StationPackInfo stationPackInfo = _stationPackInfoRepository.QueryFirst(x => x.StationCode == item.StationCode && x.AssignNum > 0);
                            if (stationPackInfo!=null)
                            {
                                var axis = _packaxisRepository.QueryFirst(x => x.DeviceCode == item.StackerCraneCode && x.StationCode == stationPackInfo.StationCode && x.PackType== stationPackInfo.PackType);
                                if (axis != null)
                                {
                                    //进行结托
                                    if (Convert.ToInt32(PackNum) == axis.PackNum)
                                    {
                                        WebResponseContent responseContent = _packaxisTaskService.BoxingInBound(item.StationCode);
                                        if (responseContent.Status)
                                        {
                                            device.Communicator.Write<short>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == GetPackSendEnum(item.StackerCraneStationCode).ToString()).DeviceProDataBlock, 2);
                                            WriteInfo(item.StationName, $"{item.StationName}写入工位结托信号");
                                        }
                                        else
                                        {
                                            WriteError(item.StationName, $"{responseContent.Message}");
                                        }
                                        continue;
                                    }
                                    //码垛申请
                                    if (Allow == 3 || Allow == 7)
                                    {
                                        //获取当前任务
                                        Dt_PackaxisTask packaxisTask = _packaxisTaskRepository.QueryFirst(x => x.NextAddress == item.StationCode && x.DeviceCode == item.StackerCraneCode && x.PackType == stationPackInfo.PackType && x.TaskState == TaskStatusEnum.MD_Executing.ObjToInt());
                                        if (packaxisTask != null)
                                        {
                                            //写入工位号
                                            device.Communicator.Write<short>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == W_MDDB.W_MDSendID.ToString()).DeviceProDataBlock, Convert.ToInt16(item.StackerCraneStationCode));
                                            //写入工位允许码垛
                                            device.Communicator.Write<short>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == GetPackSendEnum(item.StackerCraneStationCode).ToString()).DeviceProDataBlock, 1);
 
                                            #region 获取写入码垛X、Y、Z坐标
                                            (int, int, int) result = GetAxis(PackNum, axis, item.StackerCraneStationCode);
 
                                            device.Communicator.Write<float>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == W_MDDB.W_MDX.ToString()).DeviceProDataBlock, result.Item1);
 
                                            device.Communicator.Write<float>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == W_MDDB.W_MDY.ToString()).DeviceProDataBlock, result.Item2);
 
                                            device.Communicator.Write<float>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == W_MDDB.W_MDZ.ToString()).DeviceProDataBlock, result.Item3);
                                            WriteInfo(item.StationName, $"码垛数量【{PackNum}】,下发码垛坐标X、Y、Z【{result.Serialize()}】");
                                            #endregion
 
                                            device.Communicator.Write<float>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == W_MDDB.W_MDA.ToString()).DeviceProDataBlock, 1);
                                            //写入下发标识
                                            device.Communicator.Write<short>(device.DeviceProDTOs.FirstOrDefault(x => x.DeviceProParamName == W_MDDB.W_MDReceiveDone.ToString()).DeviceProDataBlock, 3);
                                            packaxisTask.TaskState = TaskStatusEnum.Finish.ObjToInt();
                                            _packaxisTaskRepository.UpdateData(packaxisTask);
                                            //任务完成
                                            WebResponseContent webResponse = _packaxisTaskService.TaskCompleted(packaxisTask: packaxisTask);
                                            if (!webResponse.Status)
                                            {
                                                WriteError(item.StationName, $"任务号{packaxisTask.PackTaskNum}码垛完成错误{webResponse.Message}");
                                            }
                                            else
                                            {
                                                WriteInfo(item.StationName, $"任务号{packaxisTask.PackTaskNum}码垛完成");
                                            }
                                            Thread.Sleep(800);
                                            return Task.CompletedTask;
                                        }
                                    }
                                }
                                else
                                {
                                    WriteError(item.StationName, $"未找到该工位{item.StationName}的坐标信息,请核对数据");
                                }
                            }
                        }
                    }
                    else
                    {
                        WriteError(device.DeviceCode, $"未找到设备{device.DeviceCode}的协议信息");
                    }
                }
            }
            catch (Exception ex)
            {
                WriteError(nameof(MDJob_CP),ex.Message);
            }
            return Task.CompletedTask;
        }
        /// <summary>
        /// 码垛数量
        /// </summary>
        public R_MDDB GetPackNumEnum(string StationCode)
        {
            switch (StationCode)
            {
                case "1":
                    return R_MDDB.R_MDQtys1;
                case "2":
                    return R_MDDB.R_MDQtys2;
                case "3":
                    return R_MDDB.R_MDQtys3;
                case "4":
                    return R_MDDB.R_MDQtys4;
                default:
                    throw new Exception("未定义工位");
            }
        }
        /// <summary>
        /// 码垛状态
        /// </summary>
        public R_MDDB GetPackStateEnum(string StationCode)
        {
            switch (StationCode)
            {
                case "1":
                    return R_MDDB.R_MDStatus1;
                case "2":
                    return R_MDDB.R_MDStatus2;
                case "3":
                    return R_MDDB.R_MDStatus3;
                case "4":
                    return R_MDDB.R_MDStatus4;
                default:
                    throw new Exception("未定义工位");
            }
        }
        /// <summary>
        /// 码垛工位
        /// </summary>
        public W_MDDB GetPackSendEnum(string StationCode)
        {
            switch (StationCode)
            {
                case "1":
                    return W_MDDB.W_MDSend1;
                case "2":
                    return W_MDDB.W_MDSend2;
                case "3":
                    return W_MDDB.W_MDSend3;
                case "4":
                    return W_MDDB.W_MDSend4;
                default:
                    throw new Exception("未定义工位");
            }
        }
        public (int, int ,int) GetAxis(int PackNum, Dt_Packaxis axis, string StationCode)
        {
            int X = PackNum / axis.AxisYCount % axis.AxisXCount;
            int Y = PackNum % axis.AxisYCount;
            int Z = PackNum / (axis.AxisYCount * axis.AxisXCount) % axis.AxisZCount;
            int axisx = 0;
            int axisy = 0;
            int axisz = 0;
            if (axis == null)
            {
                throw new Exception("未找到坐标值");
            }
            switch (StationCode)
            {
                case "1":
                    return (axisx = axis.AxisX - X * axis.AxisXSpacing, axisy = axis.AxisY + Y * axis.AxisYSpacing,axisz=  axis.AxisZ + Z * axis.AxisZSpacing);
                case "2":
                    return (axisx = axis.AxisX - X * axis.AxisXSpacing, axisy = axis.AxisY - Y * axis.AxisYSpacing, axisz = axis.AxisZ + Z * axis.AxisZSpacing);
                case "3":
                    return (axisx = axis.AxisX + X * axis.AxisXSpacing, axisy = axis.AxisY + Y * axis.AxisYSpacing, axisz = axis.AxisZ + Z * axis.AxisZSpacing);
                case "4":
                    return (axisx = axis.AxisX + X * axis.AxisXSpacing, axisy = axis.AxisY - Y * axis.AxisYSpacing, axisz = axis.AxisZ + Z * axis.AxisZSpacing);
                default:
                    throw new Exception("未定义工位");
            }
        }
    }
}