LiftContext.cs
20.6 KB
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
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
using Common;
using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading;
using System.Threading.Tasks;
using System.Web.Management;
using static DeviceLibrary.OpManager;
namespace DeviceLibrary.lift
{
public class LiftContext
{
/// <summary>
/// 所有电梯状态
/// </summary>
static Dictionary<string, LiftInfo> lifts = new Dictionary<string, LiftInfo>();
public static string GetLiftInfos()
{
try
{
return JsonHelper.SerializeObject(lifts);
}
catch { }
return "";
}
public static void Init()
{
string[] names = Common.AppConfigHelper.GetValue(Common.SettingString.Lift_Names, "LIFT_D2,LIFT_C1").Split(',');
foreach (var item in names)
{
lifts.Add(item, new LiftInfo());
}
Common.LogUtil.info($"加载电梯信息完成:{string.Join(",", names)}");
}
static object locCheckOpen = new object();
/// <summary>
/// 1楼小车检查是否有空成品车在电梯内
/// </summary>
/// <param name="agv"></param>
/// <param name="missionLiftName">当前任务的电梯名字</param>
/// <returns></returns>
public static bool CheckHasEmptyFinished(AgvInfo agv, string missionLiftName, out LiftStatus liftStatus)
{
liftStatus = GetLiftStatus(SettingString.LIFT_D2);
if (!SettingString.LIFT_D2.Equals(missionLiftName)) return false;//不是D2电梯无需检查空成品料车
if (agv?.Scope?.Workshop.Equals("1F") ?? false)
{
if (liftStatus?.HasEmptyFinishedShelf ?? false)//D2电梯有成品空架子,不返回门状态
{
//返回一个成品任务id
liftStatus.missionId = manager.MissionManager.GetMissionIdByEmptyFinishedShelfInLift(SettingString.LIFT_C1);
return true;
}
}
return false;
}
public static string GetLiftNodeOccupiedInfo()
{
try
{
StringBuilder sb = new StringBuilder();
sb.AppendLine("电梯位置占用信息");
foreach (var item in lifts)
{
sb.Append(item.Key + ":");
sb.AppendLine("[电梯占用:" + string.Join(";", item.Value.Agvs) + "]");
}
return sb.ToString();
}
catch
{
}
return "";
}
/// <summary>
/// 设置电梯节点的占用
/// </summary>
/// <param name="agv"></param>
/// <param name="liftName"></param>
public static void SetLiftNodeOccupied(AgvInfo agv, string liftName = "")
{
try
{
if (string.IsNullOrEmpty(liftName))
{
foreach (var item in lifts.Values)
{
if (item.Agvs != null && item.Agvs.Contains(agv.Name))
{
item.Agvs.Remove(agv.Name);
LogUtil.info($"【{agv.Name}】清除电梯节点占用:{string.Join(",", item.Agvs)}");
}
}
}
else
{
if (!lifts[liftName].Agvs.Contains(agv.Name))
{
lifts[liftName].Agvs.Add(agv.Name);
LogUtil.info($"【{agv.Name}】设置电梯【{liftName}】节点占用:{string.Join(",", lifts[liftName].Agvs)}");
}
}
}
catch (Exception ex)
{
LogUtil.error($"SetLiftOccupied: {agv.Name},{liftName}", ex);
}
}
/// <summary>
/// 同车间的其他小车是否占用电梯
/// </summary>
/// <param name="agv"></param>
/// <param name="liftName"></param>
/// <returns></returns>
public static bool OtherAGVIsInLift(AgvInfo agv, string liftName)
{
try
{
AgvInfo agvInfo = AGVManager.agvInfo.Find(s =>
s.Scope.Workshop.Equals(agv.Scope.Workshop) && !s.IP.Equals(agv.IP));
if (agvInfo != null)
{
return lifts[liftName].Agvs.Contains(agvInfo.Name);
}
else
return false;
}
catch (Exception ex)
{
LogUtil.error($"OtherAGVIsInLift: {agv.Name},{liftName}", ex);
}
return false;
}
/// <summary>
/// 4楼AGV是否在D2电梯
/// </summary>
/// <param name="liftName"></param>
/// <returns></returns>
public static bool F4AGVIsInD2Lift()
{
try
{
var agvs = AGVManager.agvInfo.FindAll(s =>
s.Scope.Workshop.Equals(SettingString._4D));
foreach (var item in agvs)
{
if(lifts.ContainsKey(SettingString.LIFT_D2) && lifts[SettingString.LIFT_D2].Agvs.Contains(item.Name))
{
return true;
}
}
return false;
}
catch (Exception ex)
{
LogUtil.error($"OtherAGVIsInLift: {SettingString.LIFT_D2}", ex);
}
return false;
}
/// <summary>
/// 电梯是否开门
/// </summary>
/// <param name="liftId"></param>
/// <returns></returns>
public static bool IsDoorOpen(string liftId, int floor, AgvInfo agv)
{
LiftStatus liftStatus = GetLiftStatus(liftId);
{
LogUtil.debug($"检查电梯{liftId}门是否开开启");
if (liftStatus.door.Equals("opened") && liftStatus.floor.Equals(floor) && !OtherAGVIsInLift(agv, liftId))
return true;
}
return false;
}
public static bool IsDoorOpen(string liftId)
{
LiftStatus liftStatus = GetLiftStatus(liftId);
{
LogUtil.debug($"检查电梯{liftId}门是否开开启");
if (liftStatus.door.Equals("opened"))//
return true;
}
return false;
}
/// <summary>
/// 请求使用电梯
/// </summary>
/// <param name="liftId"></param>
/// <param name="missionInfo"></param>
/// <param name="isback">是否是返回</param>
public static bool Request(service.model.MissionInfo missionInfo, AgvInfo agvInfo, bool isback = false, bool needCall = true)
{
service.model.SendInInfo info;
bool rtn = false;
if (isback)//返回
{
if (!AGVManager.GetsysClientBy(missionInfo.sourceFloor, missionInfo.liftName, out string destclient))
{
Common.LogUtil.error($"请求电梯失败,因目的系统标识获取失败:floor={agvInfo.Scope.Floor},lift={missionInfo.liftName}");
return false;
}
info = new service.model.SendInInfo()
{
liftId = missionInfo.liftName,
destinationFloor = missionInfo.sourceFloor,
destinationPoint = missionInfo.sourcePoint,
destinationClient = destclient,
sourceFloor = missionInfo.destinationFloor,
sourceClient = agvInfo.Client,
missionId = missionInfo.missionId,
};
rtn = HttpManager.RequestSendIn(info);
if (rtn)
HttpManager.AGVCall(new service.model.DoorInfo { liftId = missionInfo.liftName, sourceClient = agvInfo.Client, sourceFloor = missionInfo.destinationFloor });
}
else
{
if (!AGVManager.GetsysClientBy(missionInfo.destinationFloor, missionInfo.liftName, out string destclient))
{
Common.LogUtil.error($"请求电梯失败,因目的系统标识获取失败:floor={agvInfo.Scope.Floor},lift={missionInfo.liftName}");
return false;
}
info = new service.model.SendInInfo()
{
liftId = missionInfo.liftName,
sourceClient = agvInfo.Client,
sourceFloor = missionInfo.sourceFloor,
sourcePoint = missionInfo.sourcePoint,
destinationClient = destclient,
destinationFloor = missionInfo.destinationFloor,
destinationPoint = missionInfo.destinationPoint,
missionId = missionInfo.missionId,
};
rtn = HttpManager.RequestSendIn(info);
if (rtn && needCall)
HttpManager.AGVCall(new service.model.DoorInfo { liftId = missionInfo.liftName, sourceClient = agvInfo.Client, sourceFloor = missionInfo.sourceFloor });
}
return rtn;
}
/// <summary>
/// 更新请求信息
/// </summary>
/// <param name="missionInfo"></param>
/// <param name="agvInfo"></param>
/// <param name="isback"></param>
/// <returns></returns>
public static bool UpdateRequestInfo(service.model.MissionInfo missionInfo, AgvInfo agvInfo, bool isback = false)
{
service.model.SendInInfo info;
bool rtn = false;
if (isback)//返回
{
if (!AGVManager.GetsysClientBy(missionInfo.sourceFloor, missionInfo.liftName, out string destclient))
{
Common.LogUtil.error($"请求电梯失败,因目的系统标识获取失败:floor={agvInfo.Scope.Floor},lift={missionInfo.liftName}");
return false;
}
info = new service.model.SendInInfo()
{
liftId = missionInfo.liftName,
destinationFloor = missionInfo.sourceFloor,
destinationPoint = missionInfo.sourcePoint,
destinationClient = destclient,
sourceFloor = missionInfo.destinationFloor,
sourceClient = agvInfo.Client,
missionId = missionInfo.missionId,
updateInfo = true
};
}
else
{
if (!AGVManager.GetsysClientBy(missionInfo.destinationFloor, missionInfo.liftName, out string destclient))
{
Common.LogUtil.error($"请求电梯失败,因目的系统标识获取失败:floor={agvInfo.Scope.Floor},lift={missionInfo.liftName}");
return false;
}
info = new service.model.SendInInfo()
{
liftId = missionInfo.liftName,
sourceClient = agvInfo.Client,
sourceFloor = missionInfo.sourceFloor,
sourcePoint = missionInfo.sourcePoint,
destinationClient = destclient,
destinationFloor = missionInfo.destinationFloor,
destinationPoint = missionInfo.destinationPoint,
missionId = missionInfo.missionId,
updateInfo = true
};
}
LogUtil.info($"更新电梯请求信息:{JsonHelper.SerializeObject(info)}");
rtn = HttpManager.RequestSendIn(info);
return rtn;
}
/// <summary>
/// 成品呼叫
/// </summary>
/// <param name="missionInfo"></param>
/// <param name="agvInfo"></param>
/// <returns></returns>
public static bool FinishedRequest(service.model.MissionInfo missionInfo, AgvInfo agvInfo)
{
service.model.SendInInfo info;
bool rtn = false;
if (!AGVManager.GetsysClientBy(missionInfo.destinationFloor, Common.SettingString.LIFT_D2, out string destclient))
{
Common.LogUtil.error($"请求电梯失败,因目的系统标识获取失败:floor={agvInfo.Scope.Floor},lift={missionInfo.liftName}");
return false;
}
info = new service.model.SendInInfo()
{
liftId = Common.SettingString.LIFT_D2,
destinationFloor = missionInfo.destinationFloor,
destinationPoint = missionInfo.destinationPoint,
destinationClient = agvInfo.Client,
sourceFloor = missionInfo.destinationFloor,
sourceClient = agvInfo.Client,
missionId = missionInfo.missionId,
};
rtn = HttpManager.RequestSendIn(info);
if (rtn)
HttpManager.AGVCall(new service.model.DoorInfo { liftId = Common.SettingString.LIFT_D2, sourceClient = agvInfo.Client, sourceFloor = missionInfo.destinationFloor });
return rtn;
}
/// <summary>
/// AGV离开
/// </summary>
/// <param name="agvInfo"></param>
/// <param name="continueUse">是否继续使用电梯</param>
/// <returns></returns>
public static bool AGVLeave(string liftId, AgvInfo agvInfo, bool continueUse = true)
{
bool rtn = HttpManager.AGVLeave(new service.model.DoorInfo() { liftId = liftId, sourceClient = agvInfo.Client, sourceFloor = agvInfo.Scope.Floor, continueUse = continueUse });
Thread.Sleep(3000);
//清除电梯占用
SetLiftNodeOccupied(agvInfo);
Common.LogUtil.info($"{agvInfo.Name} 离开 {liftId}:{rtn}");
return rtn;
}
public static bool EmptyFinishedAGVLeave(string liftId, AgvInfo agvInfo)
{
bool rtn = HttpManager.AGVLeave(new service.model.DoorInfo() { liftId = liftId, sourceClient = agvInfo.Client, sourceFloor = agvInfo.Scope.Floor, continueUse = false, force = true });
Thread.Sleep(3000);
//清除电梯占用
SetLiftNodeOccupied(agvInfo);
Common.LogUtil.info($"{agvInfo.Name} 空成品料架离开 {liftId}:{rtn}");
return rtn;
}
public static bool FinishedProduct(string liftId, AgvInfo agvInfo)
{
bool rtn = HttpManager.FinishedProduct(new service.model.FinishedInfo() { liftId = liftId });
Common.LogUtil.info($"{agvInfo.Name} 送成品满料 {liftId}:{rtn}");
return rtn;
}
public static bool CloseFinishedProduct(string liftId, AgvInfo agvInfo)
{
bool rtn = HttpManager.FinishedProduct(new service.model.FinishedInfo() { liftId = liftId, HasFullFinishedShelf = false });
Common.LogUtil.info($"{agvInfo.Name} 关闭送成品满料 {liftId}:{rtn}");
return rtn;
}
/// <summary>
/// AGV呼叫
/// </summary>
/// <param name="liftId"></param>
/// <param name="agvInfo"></param>
/// <returns></returns>
public static bool AGVCall(string liftId, AgvInfo agvInfo)
{
bool rtn = HttpManager.AGVCall(new service.model.DoorInfo() { liftId = liftId, sourceClient = agvInfo.Client, sourceFloor = agvInfo.Scope.Floor });
Common.LogUtil.info($"{agvInfo.Name} 呼叫 {rtn}");
return rtn;
}
/// <summary>
/// 成品入库送到楼下
/// 只针对D2电梯
/// </summary>
/// <param name="liftId"></param>
/// <param name="hasFullFinished"></param>
/// <returns></returns>
public static bool SetFinishedState(string liftId, bool hasFullFinished)
{
bool rtn = HttpManager.SetFinishedState(new service.model.FinishedInfo() { liftId = liftId, HasFullFinishedShelf = hasFullFinished });
Common.LogUtil.info($"设置电梯{liftId}成品状态为{hasFullFinished}");
return rtn;
}
/// <summary>
/// 检查离开信号发送情况
/// </summary>
/// <param name="liftId"></param>
/// <returns></returns>
public static bool CheckAgvLeaveSig(string liftId)
{
if (!lifts[liftId].LiftStatus.door.Equals("opened"))
return true;
return false;
}
/// <summary>
/// 有架子需要离开电梯
/// </summary>
/// <param name="liftId"></param>
/// <returns></returns>
public static bool HasShelfNeedLeave(string liftId, string client, out LiftStatus liftStatus)
{
liftStatus = GetLiftStatus(liftId);
if (liftStatus.destinationClient.Equals(client))
{
liftStatus.missionId = manager.MissionManager.GetMissionIdByShelfInLift(liftId);
return true;
}
return false;
}
public static bool HasShelfNeedLeaveFinished(string liftId, string client, out LiftStatus liftStatus)
{
liftStatus = GetLiftStatus(liftId);
if (liftStatus.destinationClient.Equals(client) && liftStatus.sourceClient.Equals(client))
return false;
if (liftStatus.destinationClient.Equals(client))
{
liftStatus.missionId = manager.MissionManager.GetMissionIdByShelfInLift(liftId);
liftStatus.missionId = manager.MissionManager.GetMissionIdByShelfInLift(liftId);
return true;
}
return false;
}
/// <summary>
/// 有成品架子需要离开电梯
/// </summary>
/// <param name="liftId"></param>
/// <param name="client"></param>
/// <param name="liftStatus"></param>
/// <returns></returns>
public static bool HasFinishedShelfNeedLeave(string liftId, string client, out LiftStatus liftStatus)
{
liftStatus = GetLiftStatus(liftId);
liftStatus.missionId = manager.MissionManager.GetByFinishedShelfNeedLeaveInLift(liftId);
if (!liftStatus.missionId.Equals(""))
return true;
return false;
}
public static bool HasEmptyFinishedShelfNeedLeave(out LiftStatus liftStatus)
{
liftStatus = GetLiftStatus(SettingString.LIFT_D2);
liftStatus.missionId = manager.MissionManager.GetMissionIdByEmptyFinishedShelfInLift(SettingString.LIFT_C1);
if (!liftStatus.missionId.Equals(""))
return true;
return false;
}
public static bool EmptyFinishedShelfSig(string liftName)
{
if (!SettingString.LIFT_D2.Equals(liftName)) return false;
LiftStatus liftStatus = GetLiftStatus(SettingString.LIFT_D2);
if (liftStatus?.HasEmptyFinishedShelf ?? false)
return true;
else
return false;
}
/// <summary>
/// 检查该任务agv是否获得电梯控制权
/// </summary>
/// <param name="liftId"></param>
/// <param name="missionId"></param>
/// <returns></returns>
public static bool CheckIfRequestOk(string liftId, service.model.MissionInfo mission)
{
LiftStatus liftStatus = GetLiftStatus(liftId);
if (liftStatus.missionId.Equals(mission.missionId))
return true;
return false;
}
/// <summary>
/// 获取电梯状态
/// </summary>
/// <param name="liftId"></param>
/// <returns></returns>
public static LiftStatus GetLiftStatus(string liftId)
{
if (lifts.ContainsKey(liftId))
{
return lifts[liftId].LiftStatus.ToCopy();
}
else
return new LiftStatus();
}
public static string[] GetLiftNames()
{
return lifts.Keys.ToArray();
}
public static void UpdateStatus(ClientStatus status)
{
try
{
LiftStatus lift = HttpManager.UpdateStatusToLift(status);
if (lift != null)
{
lifts[status.liftId].LiftStatus = lift;
}
}
catch (Exception e)
{
Common.LogUtil.error($"上报状态给电梯失败:{status.ToString()}", e);
}
}
}
}