DeviceExtension.cs 36 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995
  1. using DBHelper;
  2. using System;
  3. using System.Collections.Generic;
  4. using System.Linq;
  5. using WCS.Core;
  6. using WCS.Entity;
  7. using WCS.Entity.Protocol;
  8. using WCS.Entity.Protocol.RGV;
  9. using WCS.Service.Helpers;
  10. using WCS.Service.Log;
  11. namespace WCS.Service.Extensions
  12. {
  13. /// <summary>
  14. /// 输送机设备组
  15. /// </summary>
  16. public class StationDeviceGroup : DeviceGroup<IStation520, IStation521, IStation523>
  17. {
  18. /// <summary>
  19. /// 当前设备可用的RGV
  20. /// </summary>
  21. private static List<RGVDevice> AllRGVList;
  22. static StationDeviceGroup()
  23. {
  24. AllRGVList = Device.Where(v => v.IsRGV() && v.CODE != "RGV8").Select(v => v.Create<RGVDevice>()).ToList();
  25. }
  26. public StationDeviceGroup(WCS_DEVICE entity) : base(entity)
  27. {
  28. }
  29. /// <summary>
  30. /// 执行输送机设备组任务 单例锁
  31. /// </summary>
  32. /// <param name="act"></param>
  33. public void EX(Action<StationDeviceGroup> act)
  34. {
  35. try
  36. {
  37. if (ExDevice.Any(v => v == Entity.CODE)) throw new WarnException($"[{Entity.CODE}]--触发并发管控");
  38. OperateExDevice(Entity.CODE);
  39. act(this);
  40. }
  41. catch (DoException ex)
  42. {
  43. ex.DoExceptionEX(Entity);
  44. }
  45. catch (WarnException ex)
  46. {
  47. ex.WarnExceptionEX(Entity);
  48. }
  49. catch (Exception ex)
  50. {
  51. ex.ExceptionEx(Entity);
  52. }
  53. finally
  54. {
  55. OperateExDevice(Entity.CODE);
  56. }
  57. }
  58. /// <summary>
  59. /// 当前设备可用的RGV
  60. /// </summary>
  61. public List<RGVDevice> RgvList
  62. {
  63. get
  64. {
  65. return AllRGVList.Where(v => v.LocationList.Any(p => p.Entity == Entity)).ToList();
  66. }
  67. }
  68. /// <summary>
  69. /// 当前设备环穿组
  70. /// </summary>
  71. private List<StationLocation> LoncationList
  72. {
  73. get
  74. {
  75. var dev = StationLocation.ALLlocations.FirstOrDefault(v => v.Station == Entity.CODE);
  76. return StationLocation.ALLlocations.Where(v => v.PLC == dev.PLC).ToList();
  77. }
  78. }
  79. /// <summary>
  80. /// 设备组自身的位置
  81. /// </summary>
  82. public float Position
  83. {
  84. get
  85. {
  86. return StationLocation.ALLlocations.FirstOrDefault(v => v.Station == Entity.CODE).Location;
  87. }
  88. }
  89. /// <summary>
  90. /// 设备组所在环穿的总长度
  91. /// </summary>
  92. public float Length
  93. {
  94. get
  95. {
  96. return StationLocation.ALLlocations.FirstOrDefault(v => v.Station == Entity.CODE).Length;
  97. }
  98. }
  99. /// <summary>
  100. /// 设备组是否满足任务执行条件
  101. /// </summary>
  102. /// <param name="type">给当前设备组下发任务时需要的请求</param>
  103. /// <returns>true:不满足执行条件需要进行停止执行 false:表示满足条件不需要停止执行 </returns>
  104. /// <exception cref="Exception"></exception>
  105. public void WhetherToExecute(IstationRequest type = IstationRequest.无)
  106. {
  107. foreach (var item in Items)
  108. {
  109. if (item.Data.VoucherNo != item.Data2.VoucherNo) throw new WarnException($"等待{item.Entity.CODE}执行任务{item.Data.Tasknum},凭证号不一致");
  110. if (item.Data3.Status.HasFlag(StationStatus.运行状态位)) throw new DoException($"{item.Entity.CODE}运行中");
  111. if (!item.Data2.Status.HasFlag(IstationStatus.光电状态)) throw new DoException($"[{item.Entity.CODE}]无光电");
  112. }
  113. }
  114. /// <summary>
  115. /// 获取设备组中需要取货的设备
  116. /// </summary>
  117. /// <param name="obj"></param>
  118. /// <returns></returns>
  119. public List<Device<IStation520, IStation521, IStation523>> RGVGetTaskedDevice()
  120. {
  121. var a = Items.Where(v => v.Data2.Status.HasFlag(IstationStatus.光电状态) && v.Data2.Tasknum > 10000)
  122. .Where(v => v.Entity.CODE.ToShort() != v.Data2.Goodsend && v.Data2.Goodsend != 0)
  123. .ToList();
  124. return a.Count == 0 ? null : a;
  125. }
  126. /// <summary>
  127. /// 获取设备组中需要分配目标地址的设备
  128. /// </summary>
  129. /// <param name="obj"></param>
  130. /// <returns></returns>
  131. public List<Device<IStation520, IStation521, IStation523>> TaskedDeviceGetNextAddress()
  132. {
  133. var a = Items.Where(v => v.Data2.Status.HasFlag(IstationStatus.光电状态) && v.Data2.Tasknum > 10000)
  134. .Where(v => v.Data2.Goodsend != 0)
  135. .ToList();
  136. return a.Count == 0 ? null : a;
  137. }
  138. /// <summary>
  139. ///
  140. /// </summary>
  141. /// <returns></returns>
  142. public RGVDevice NextRGV()
  143. {
  144. return new RGVDevice(new WCS_DEVICE());
  145. }
  146. /// <summary>
  147. /// 计算目标RGV与站台自身的距离
  148. /// </summary>
  149. /// <param name="rgv"></param>
  150. /// <returns></returns>
  151. public float Distance(RGVDevice rgv)
  152. {
  153. return DevEX.Distance(Position, rgv.Position, Length);
  154. }
  155. /// <summary>
  156. /// 计算两个站台之间的距离
  157. /// </summary>
  158. /// <param name="rgv"></param>
  159. /// <returns></returns>
  160. public float Distance(StationDeviceGroup dev)
  161. {
  162. return DevEX.Distance(Position, dev.Position, Length);
  163. }
  164. /// <summary>
  165. /// 当前RGV
  166. /// </summary>
  167. /// <returns></returns>
  168. public RGVDevice CurrentRGV()
  169. {
  170. //RGV与站台距离误差为 正负50
  171. var max = Position + 500;
  172. var min = Position - 500;
  173. return RgvList?.FirstOrDefault(v => v.Data2.Position < max && v.Data2.Position > min);
  174. }
  175. /// <summary>
  176. /// 是否需要RGV
  177. /// </summary>
  178. /// <returns>true:需要RGV false:不需要RGV</returns>
  179. public bool NeedRgv()
  180. {
  181. var rgvs = Device.Where(v => v.IsRGV()).Select(v => v.Device<IRGV521>());
  182. var code = Entity.CODE.Replace("G", "").ToShort();
  183. if (rgvs.Any(v => v.Data.DestPosition_1 == code && v.Data.SystemStatus != RGVRunStatus.空闲))
  184. throw new WarnException("已有RGV执行中");
  185. foreach (var item in Items)
  186. {
  187. if (item.Data3.Status.HasFlag(StationStatus.运行状态位)) return false;
  188. if (!item.Data2.Status.HasFlag(IstationStatus.光电状态)) return false;
  189. }
  190. return true;
  191. }
  192. }
  193. /// <summary>
  194. /// 输送机设备
  195. /// </summary>
  196. public class StationDevice : Device<IStation520, IStation521, IStation523>
  197. {
  198. public StationDevice(WCS_DEVICE entity) : base(entity)
  199. {
  200. }
  201. /// <summary>
  202. /// 设备组是否满足任务执行条件
  203. /// </summary>
  204. /// <param name="type">给当前设备组下发任务时需要的请求</param>
  205. /// <returns>true:不满足执行条件需要进行停止执行 false:表示满足条件不需要停止执行 </returns>
  206. /// <exception cref="Exception"></exception>
  207. public void WhetherToExecute(IstationRequest type = IstationRequest.无)
  208. {
  209. //正在运行
  210. if (Data3.Status.HasFlag(StationStatus.运行状态位)) throw new DoException("运行中");
  211. //上一次的任务还未执行
  212. if (Data.VoucherNo != Data2.VoucherNo)
  213. throw new WarnException($"等待任务[{Data2.Tasknum}]执行");
  214. //没有光电
  215. if (!Data2.Status.HasFlag(IstationStatus.光电状态)) throw new DoException("无光电"); ;
  216. //没有任务号
  217. switch (type)
  218. {
  219. case IstationRequest.无:
  220. if (Data2.Tasknum < 10000 && Data.Tasknum < 10000)
  221. throw new WarnException($"设备无任务");
  222. break;
  223. case IstationRequest.扫码入库:
  224. if (Data2.Tasknum > 10000 && Data.Tasknum > 10000)
  225. throw new WarnException($"设备已有任务任务");
  226. break;
  227. case IstationRequest.堆垛机放货完成请求目标地址:
  228. if (Data2.Tasknum < 10000 && Data.Tasknum < 10000)
  229. throw new WarnException($"设备无任务信息");
  230. break;
  231. case IstationRequest.请求分配目标地址:
  232. if (Data2.Tasknum < 10000 && Data.Tasknum < 10000)
  233. throw new WarnException($"设备无任务信息");
  234. break;
  235. }
  236. //没有请求
  237. if (type != IstationRequest.无 && Data2.Request != type)
  238. throw new WarnException($"有光电无{type}请求");
  239. }
  240. /// <summary>
  241. /// 执行输送机任务 单例锁
  242. /// </summary>
  243. /// <param name="act"></param>
  244. public void EX(Action<StationDevice> act)
  245. {
  246. try
  247. {
  248. if (ExDevice.Any(v => v == Entity.CODE)) throw new WarnException($"[{Entity.CODE}]--触发并发管控");
  249. OperateExDevice(Entity.CODE);
  250. act(this);
  251. }
  252. catch (DoException ex)
  253. {
  254. ex.DoExceptionEX(Entity);
  255. }
  256. catch (WarnException ex)
  257. {
  258. ex.WarnExceptionEX(Entity);
  259. }
  260. catch (Exception ex)
  261. {
  262. ex.ExceptionEx(Entity);
  263. }
  264. finally
  265. {
  266. OperateExDevice(Entity.CODE);
  267. }
  268. }
  269. }
  270. /// <summary>
  271. /// RGV设备
  272. /// </summary>
  273. public class RGVDevice : Device<IRGV520, IRGV521, IRGV523>
  274. {
  275. static RGVDevice()
  276. {
  277. AllRGVList = Device.Where(v => v.IsRGV() && v.CODE != "RGV8").Select(v => v.Create<RGVDevice>()).ToList();
  278. }
  279. public RGVDevice(WCS_DEVICE entity) : base(entity)
  280. {
  281. }
  282. /// <summary>
  283. /// 所有环穿RGV
  284. /// </summary>
  285. private static List<RGVDevice> AllRGVList { get; set; }
  286. /// <summary>
  287. /// 与当前RGV处于同一环穿的RGV
  288. /// </summary>
  289. public List<RGVDevice> RGVList
  290. {
  291. get
  292. {
  293. return AllRGVList.Where(v => v.Entity.PROTOCOLS.Any(d => Entity.PROTOCOLS.Any(e => e.DB.PLC.IP == d.DB.PLC.IP)))
  294. .Where(v => v.Entity.CODE != Entity.CODE).ToList();
  295. }
  296. }
  297. /// <summary>
  298. /// RGV当前位置
  299. /// </summary>
  300. public float Position
  301. {
  302. get
  303. {
  304. return Data2.Position;
  305. }
  306. }
  307. /// <summary>
  308. /// 与当前RGV处于同一环穿的站台
  309. /// </summary>
  310. public List<StationDeviceGroup> LocationList
  311. {
  312. get
  313. {
  314. return StationLocation.ALLlocations.Where(v => Entity.PROTOCOLS.Any(p => p.DB.PLC.CODE == v.PLC))
  315. .Select(v => Device.Find(v.Station).Create<StationDeviceGroup>()).ToList();
  316. }
  317. }
  318. /// <summary>
  319. /// 总长度
  320. /// </summary>
  321. public float Length
  322. {
  323. get
  324. {
  325. return LocationList.FirstOrDefault().Length;
  326. }
  327. }
  328. /// <summary>
  329. /// 执行RGV任务 单例锁
  330. /// </summary>
  331. /// <param name="act"></param>
  332. public void EX(Action<RGVDevice> act)
  333. {
  334. try
  335. {
  336. if (ExDevice.Any(v => v == Entity.CODE)) throw new WarnException($"[{Entity.CODE}]--触发并发管控");
  337. OperateExDevice(Entity.CODE);
  338. act(this);
  339. }
  340. catch (DoException ex)
  341. {
  342. ex.DoExceptionEX(Entity);
  343. }
  344. catch (WarnException ex)
  345. {
  346. ex.WarnExceptionEX(Entity);
  347. }
  348. catch (Exception ex)
  349. {
  350. ex.ExceptionEx(Entity);
  351. }
  352. finally
  353. {
  354. OperateExDevice(Entity.CODE);
  355. }
  356. }
  357. /// <summary>
  358. /// 获取前一个取货点
  359. /// </summary>
  360. /// <returns></returns>
  361. public StationDeviceGroup BeforeStation()
  362. {
  363. return LocationList.Where(v => v.Entity.Is(DF.涂布RGV取货设备组)).OrderBy(v => Distance(v)).FirstOrDefault();
  364. }
  365. /// <summary>
  366. /// 前一个RGV
  367. /// </summary>
  368. /// <returns></returns>
  369. public RGVDevice Before()
  370. {
  371. //按照位置排序
  372. var arr = RGVList.OrderBy(v => v.Position);
  373. var rgv = arr.FirstOrDefault(v => v.Position > Position);
  374. if (rgv == null)
  375. rgv = arr.LastOrDefault(v => v.Position < Position);
  376. return rgv;
  377. }
  378. /// <summary>
  379. /// 后一个RGV
  380. /// </summary>
  381. /// <returns></returns>
  382. public RGVDevice After()
  383. {
  384. //到当前RGV最近的一个RGV
  385. return RGVList.OrderBy(v => v.Distance(this)).FirstOrDefault();
  386. }
  387. /// <summary>
  388. /// 获取当前所在的取货站台
  389. /// </summary>
  390. /// <returns></returns>
  391. public StationDeviceGroup CurrentStation()
  392. {
  393. return LocationList.Where(v => v.Entity.Is(DF.涂布RGV取货设备组) || v.Entity.Is(DF.涂布RGV放货设备组)).Where(v =>
  394. {
  395. //RGV与站台距离误差为 正负50500
  396. var max = v.Position + 500;
  397. var min = v.Position - 500;
  398. return Data2.Position < max && Data2.Position > min;
  399. }).FirstOrDefault();
  400. }
  401. /// <summary>
  402. /// 计算当前RGV与指定RGV之间的距离
  403. /// </summary>
  404. /// <param name="rgv"></param>
  405. /// <returns></returns>
  406. public float Distance(RGVDevice rgv)
  407. {
  408. //return Math.Abs((Position - rgv.Position + Length) % Length);
  409. return DevEX.Distance(Position, rgv.Position, Length);
  410. }
  411. /// <summary>
  412. /// 计算当前RGV与指定R站台之间的距离
  413. /// </summary>
  414. /// <param name="after"></param>
  415. /// <returns></returns>
  416. public float Distance(StationDeviceGroup after)
  417. {
  418. return DevEX.Distance(Position, after.Position, Length);
  419. }
  420. /// <summary>
  421. /// 是否需要执行放货任务
  422. /// </summary>
  423. /// <returns></returns>
  424. public bool IsPut()
  425. {
  426. if (Data2.TaskType_1 != RGVTaskType.取货) return false;
  427. if (!Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.RGV到站)) return false;
  428. if (!Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.任务完成)) return false;
  429. if (!Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.光电)) return false;
  430. return true;
  431. }
  432. /// <summary>
  433. /// 写入移动任务
  434. /// </summary>
  435. /// <param name="addr">目标地址</param>
  436. public void Move(StationDeviceGroup addr)
  437. {
  438. if (Data2.WorkMode != RGVMode.自动) throw new WarnException($"RGV状态{Data2.WorkMode},无法执行移动任务");
  439. if (Data2.SystemStatus != RGVRunStatus.空闲) throw new WarnException($"rgv状态为{Data2.SystemStatus},无法执行移动任务");
  440. Data.TaskID_1 = addr.Entity.CODE.Replace("G", "").ToShort();
  441. Data.TaskType_1 = RGVTaskType.移动;
  442. Data.DestPosition_1 = addr.Entity.CODE.Replace("G", "").ToShort();
  443. Data.Trigger_1++;
  444. }
  445. /// <summary>
  446. /// 写入取货任务
  447. /// </summary>
  448. /// <param name="addr">目标地址</param>
  449. public void Pick(StationDeviceGroup addr, int task1 = 0, int task2 = 0)
  450. {
  451. Data.TaskType_1 = RGVTaskType.取货;
  452. Data.DestPosition_1 = addr.Entity.CODE.ToShort();
  453. if (task1 != 0) Data.TaskID_1 = task1;
  454. if (task2 != 0) Data.TaskID_2 = task2;
  455. Data.Trigger_1++;
  456. }
  457. /// <summary>
  458. /// 写入放货任务
  459. /// </summary>
  460. /// <param name="addr">目标地址</param>
  461. public void Put(StationDeviceGroup addr, int task1 = 0, int task2 = 0)
  462. {
  463. Data.TaskType_1 = RGVTaskType.放货;
  464. Data.DestPosition_1 = addr.Entity.CODE.Replace("G", "").ToShort();
  465. if (task1 != 0) Data.TaskID_1 = task1;
  466. if (task2 != 0) Data.TaskID_2 = task2;
  467. Data.Trigger_1++;
  468. }
  469. /// <summary>
  470. /// 筛选出所有与当前RGV距离小于指定长度的RGV
  471. /// </summary>
  472. /// <param name="distance">指定长度</param>
  473. /// <returns></returns>
  474. public RGVDevice[] RgvAfter(float distance)
  475. {
  476. return RGVList.Where(v => Distance(v) < distance).ToArray();
  477. }
  478. /// <summary>
  479. /// 当前RGV是否有拦住其他RGV
  480. /// </summary>
  481. /// <param name="rgv">RGV</param>
  482. /// <returns></returns>
  483. public bool StopedByMe(RGVDevice rgv)
  484. {
  485. //目标站台
  486. var target = rgv.Data2.DestPosition_1;
  487. //获取目标站台的设备组信息
  488. var station = Device.Find($"G{target}").Create<StationDeviceGroup>();
  489. //当前RGV与目标站台的距离小于传入RGV到达目标站台的距离
  490. return (this.Distance(station) < rgv.Distance(station)) || station.CurrentRGV()?.Entity.CODE == this.Entity.CODE;
  491. }
  492. /// <summary>
  493. /// 获取当前RGV的下一个站台,即距离最近的一个站台
  494. /// </summary>
  495. /// <returns></returns>
  496. public StationDeviceGroup NextStation()
  497. {
  498. //先取当前RGV与所有站台的距离
  499. var dev = LocationList.OrderBy(v => v.Distance(this)).FirstOrDefault();
  500. return dev;
  501. }
  502. }
  503. /// <summary>
  504. /// 堆垛机设备
  505. /// </summary>
  506. public class SRMDevice : Device<ISRM520, ISRM521, ISRM537>
  507. {
  508. public SRMDevice(WCS_DEVICE entity) : base(entity)
  509. {
  510. }
  511. /// <summary>
  512. /// 获取放货点
  513. /// </summary>
  514. public List<StationDevice> GetDeliveryPoint()
  515. {
  516. return Entity.ROUTES.Select(v => v.NEXT) //巷道
  517. .SelectMany(v => v.ROUTES.Select(d => d.NEXT)) //放货点
  518. .Where(v => v.IsConv()) //必须是输送线
  519. .Select(v => v.Create<StationDevice>()).ToList();
  520. }
  521. /// <summary>
  522. /// 获取取货点
  523. /// </summary>
  524. public List<StationDevice> GetPickPoint()
  525. {
  526. return Device.Where(v => v.Is(DF.SRM二级品取货) || v.Is(DF.SRM涂布取货))
  527. .Where(v => v.ROUTES.Any(p => p.NEXT.ROUTES.Any(d => d.NEXT == Entity)))
  528. .Select(v => v.Create<StationDevice>())
  529. .ToList();
  530. }
  531. /// <summary>
  532. /// 处理完成任务
  533. /// </summary>
  534. public void FinishedTaskHandle()
  535. {
  536. WCS_TASK task = new WCS_TASK();
  537. DB.Do(db =>
  538. {
  539. var taskIds = new List<int>() { Data2.FinishedTask_1, Data2.FinishedTask_2 }.ToArray();
  540. for (int i = 0; i < taskIds.Length; i++)
  541. {
  542. //判断当前工位是否有完成任务
  543. if (taskIds[i] == 0) continue;
  544. //获取当前工位的目标地址
  545. var ELine = i == 0 ? Data.ELine_1.ToString() : Data.ELine_2.ToString();
  546. task = db.Default.Set<WCS_TASK>().Single(v => taskIds[i] == v.ID);
  547. if (task.STATUS != TaskStatus.堆垛机执行 && task.STATUS != TaskStatus.堆垛机完成) continue;
  548. if (task.STATUS == TaskStatus.堆垛机完成)
  549. {
  550. if (i == 0) Data.FinishedACK_1 = 1;
  551. else Data.FinishedACK_2 = 1;
  552. throw new DoException("二次处理堆垛机完成任务");
  553. }
  554. if (task.STATUS == TaskStatus.已完成)
  555. {
  556. if (i == 0) Data.FinishedACK_1 = 1;
  557. else Data.FinishedACK_2 = 1;
  558. throw new DoException("二次处理堆垛机完成任务");
  559. }
  560. if (task.TYPE == TaskType.入库)
  561. {
  562. task.ENDTIME = DateTime.Now;
  563. task.STATUS = TaskStatus.已完成;
  564. task.UPDATETIME = DateTime.Now;
  565. db.Default.SaveChanges();
  566. }
  567. else if (task.TYPE == TaskType.出库)
  568. {
  569. task.STATUS = TaskStatus.堆垛机完成;
  570. task.UPDATETIME = DateTime.Now;
  571. db.Default.SaveChanges();
  572. Uploader.Upload(db);
  573. }
  574. else if (task.TYPE == TaskType.移库)
  575. {
  576. if (task.STATUS == TaskStatus.堆垛机执行)
  577. {
  578. task.STATUS = TaskStatus.已完成;
  579. task.UPDATETIME = DateTime.Now;
  580. db.Default.SaveChanges();
  581. Uploader.Upload(db);
  582. }
  583. }
  584. else throw new Exception($"[{Entity.CODE}]任务类型错误");
  585. task.CreateStatusLog(db, $"状态由[{TaskStatus.堆垛机执行}]变更为[{task.STATUS}]", this.GetType());
  586. }
  587. });
  588. DB.Do(db =>
  589. {
  590. var taskIds = new List<int>() { Data2.FinishedTask_1, Data2.FinishedTask_2 }.ToArray();
  591. for (int i = 0; i < taskIds.Length; i++)
  592. {
  593. //判断当前工位是否有完成任务
  594. if (taskIds[i] == 0) continue;
  595. //获取当前工位的目标地址
  596. var ELine = i == 0 ? Data.ELine_1.ToString() : Data.ELine_2.ToString();
  597. task = db.Default.Set<WCS_TASK>().Single(v => taskIds[i] == v.ID);
  598. if (task.TYPE == TaskType.入库 && task.STATUS == TaskStatus.已完成)
  599. {
  600. if (i == 0) Data.FinishedACK_1 = 1;
  601. else Data.FinishedACK_2 = 1;
  602. }
  603. else if (task.TYPE == TaskType.出库 && task.STATUS == TaskStatus.堆垛机完成)
  604. {
  605. var target = Device.Find(ELine).Create<StationDevice>();
  606. target.Data.Tasknum = task.ID;
  607. target.Data.Goodsstart = ELine.ToShort();
  608. target.Data.Goodsend = task.ADDRNEXT.ToShort();
  609. if (i == 0) Data.FinishedACK_1 = 1;
  610. else Data.FinishedACK_2 = 1;
  611. }
  612. else if (task.TYPE == TaskType.移库 && task.STATUS == TaskStatus.堆垛机完成)
  613. {
  614. if (i == 0) Data.FinishedACK_1 = 1;
  615. else Data.FinishedACK_2 = 1;
  616. }
  617. else throw new Exception($"[{Entity.CODE}]任务类型错误");
  618. task.CreateStatusLog(db, $"状态由[{TaskStatus.堆垛机执行}]变更为[{task.STATUS}]", this.GetType());
  619. }
  620. });
  621. }
  622. /// <summary>
  623. /// 执行堆垛机任务 单例锁
  624. /// </summary>
  625. /// <param name="act"></param>
  626. public void EX(Action<SRMDevice> act)
  627. {
  628. try
  629. {
  630. if (ExDevice.Any(v => v == Entity.CODE)) throw new WarnException($"[{Entity.CODE}]--触发并发管控");
  631. OperateExDevice(Entity.CODE);
  632. act(this);
  633. }
  634. catch (DoException ex)
  635. {
  636. ex.DoExceptionEX(Entity);
  637. }
  638. catch (WarnException ex)
  639. {
  640. ex.WarnExceptionEX(Entity);
  641. }
  642. catch (Exception ex)
  643. {
  644. ex.ExceptionEx(Entity);
  645. }
  646. finally
  647. {
  648. OperateExDevice(Entity.CODE);
  649. }
  650. }
  651. /// <summary>
  652. /// 执行出库任务 出库单例锁
  653. /// </summary>
  654. /// <param name="act"></param>
  655. public void EXOutStock(Action<SRMDevice> act)
  656. {
  657. try
  658. {
  659. var code = "";
  660. if (Entity.CODE == "SRM3" || Entity.CODE == "SRM4")
  661. {
  662. code = "SRM3-SRM4-Out";
  663. if (ExDevice.Any(v => v == code)) throw new WarnException($"触发出库并发管控--[{code}]");
  664. OperateExDevice(code);
  665. }
  666. if (Entity.CODE == "SRM5" || Entity.CODE == "SRM6")
  667. {
  668. code = "SRM5-SRM6-Out";
  669. if (ExDevice.Any(v => v == code)) throw new WarnException($"触发出库并发管控--[{code}]");
  670. OperateExDevice(code);
  671. }
  672. if (Entity.CODE == "SRM7" || Entity.CODE == "SRM8")
  673. {
  674. code = "SRM7-SRM8-Out";
  675. if (ExDevice.Any(v => v == code)) throw new WarnException($"触发出库并发管控--[{code}]");
  676. OperateExDevice(code);
  677. }
  678. act(this);
  679. }
  680. finally
  681. {
  682. if (Entity.CODE == "SRM3" || Entity.CODE == "SRM4") OperateExDevice("SRM3-SRM4-Out");
  683. if (Entity.CODE == "SRM5" || Entity.CODE == "SRM6") OperateExDevice("SRM5-SRM6-Out");
  684. if (Entity.CODE == "SRM7" || Entity.CODE == "SRM8") OperateExDevice("SRM7-SRM8-Out");
  685. }
  686. }
  687. /// <summary>
  688. /// 一工位写任务
  689. /// </summary>
  690. /// <param name="task"></param>
  691. public void WriteTask1(Task task)
  692. {
  693. InfoLog.INFO_SRMINFO($"写入堆垛机[{Entity.CODE}]1工位-开始:[{Data.TaskID_1}][{Data.SLine_1}][{Data.SCol_1}][{Data.SLayer_1}][{Data.ELine_1}][{Data.VoucherNo_1}]");
  694. Data.TaskID_1 = task.ID;
  695. Data.SLine_1 = task.Line;
  696. Data.SCol_1 = task.Col;
  697. Data.SLayer_1 = task.Layer;
  698. Data.ELine_1 = task.SRMSTATION.ToShort();
  699. Data.ECol_1 = 0;
  700. Data.ELayer_1 = 0;
  701. Data.VoucherNo_1++;
  702. InfoLog.INFO_SRMINFO($"写入堆垛机[{Entity.CODE}]1工位-结束:[{Data.TaskID_1}][{Data.SLine_1}][{Data.SCol_1}][{Data.SLayer_1}][{Data.ELine_1}][{Data.VoucherNo_1}]");
  703. }
  704. /// <summary>
  705. /// 二工位写任务
  706. /// </summary>
  707. /// <param name="task"></param>
  708. public void WriteTask2(Task task)
  709. {
  710. InfoLog.INFO_SRMINFO($"写入堆垛机[{Entity.CODE}]2工位-开始:[{Data.TaskID_2}][{Data.SLine_2}][{Data.SCol_2}][{Data.SLayer_2}][{Data.ELine_2}][{Data.VoucherNo_2}]");
  711. Data.TaskID_2 = task.ID;
  712. Data.SLine_2 = task.Line;
  713. Data.SCol_2 = task.Col;
  714. Data.SLayer_2 = task.Layer;
  715. Data.ELine_2 = task.SRMSTATION.ToShort();
  716. Data.ECol_2 = 0;
  717. Data.ELayer_2 = 0;
  718. Data.VoucherNo_2++;
  719. InfoLog.INFO_SRMINFO($"写入堆垛机[{Entity.CODE}]2工位-结束:[{Data.TaskID_2}][{Data.SLine_2}][{Data.SCol_2}][{Data.SLayer_2}][{Data.ELine_2}][{Data.VoucherNo_2}]");
  720. }
  721. /// <summary>
  722. /// 获取任务对应的货叉
  723. /// </summary>
  724. /// <param name="task">任务信息</param>
  725. /// <param name="index">任务在下发任务集合中的索引</param>
  726. /// <returns></returns>
  727. public SrmFork GetFork(Task task, int index)
  728. {
  729. if (index > 1) throw new WarnException("一次最多下发两个任务");
  730. //如果索引是1,直接返回货叉2
  731. if (index == 1) return SrmFork.货叉2;
  732. //判断任务列是多少
  733. return task.Col switch
  734. {
  735. 102 => Entity.CODE switch
  736. {
  737. "SRM1" => SrmFork.货叉1,
  738. _ => SrmFork.货叉2,
  739. },
  740. 112 => SrmFork.货叉2,
  741. _ => SrmFork.货叉1,
  742. };
  743. }
  744. /// <summary>
  745. /// 检查同组堆垛机是否有出库任务正在执行
  746. /// </summary>
  747. public void CheckOutTask()
  748. {
  749. //检查同组堆垛机是否有正在执行出库任务的
  750. DB.Do(db =>
  751. {
  752. switch (Entity.CODE)
  753. {
  754. case "SRM3":
  755. if (db.Default.Set<WCS_TASK>().Any(v => v.STATUS == TaskStatus.堆垛机执行 && v.DEVICE == "SRM4" && v.TYPE == TaskType.出库))
  756. throw new DoException("SRM4正在执行出库任务");
  757. break;
  758. case "SRM4":
  759. if (db.Default.Set<WCS_TASK>().Any(v => v.STATUS == TaskStatus.堆垛机执行 && v.DEVICE == "SRM3" && v.TYPE == TaskType.出库))
  760. throw new DoException("SRM3正在执行出库任务");
  761. break;
  762. case "SRM5":
  763. if (db.Default.Set<WCS_TASK>().Any(v => v.STATUS == TaskStatus.堆垛机执行 && v.DEVICE == "SRM6" && v.TYPE == TaskType.出库))
  764. throw new DoException("SRM6正在执行出库任务");
  765. break;
  766. case "SRM6":
  767. if (db.Default.Set<WCS_TASK>().Any(v => v.STATUS == TaskStatus.堆垛机执行 && v.DEVICE == "SRM5" && v.TYPE == TaskType.出库))
  768. throw new DoException("SRM5正在执行出库任务");
  769. break;
  770. case "SRM7":
  771. if (db.Default.Set<WCS_TASK>().Any(v => v.STATUS == TaskStatus.堆垛机执行 && v.DEVICE == "SRM7" && v.TYPE == TaskType.出库))
  772. throw new DoException("SRM7正在执行出库任务");
  773. break;
  774. case "SRM8":
  775. if (db.Default.Set<WCS_TASK>().Any(v => v.STATUS == TaskStatus.堆垛机执行 && v.DEVICE == "SRM8" && v.TYPE == TaskType.出库))
  776. throw new DoException("SRM8正在执行出库任务");
  777. break;
  778. }
  779. });
  780. }
  781. }
  782. /// <summary>
  783. /// 异常处理
  784. /// </summary>
  785. public static class DevEX
  786. {
  787. /// <summary>
  788. /// 计算两点距离
  789. /// </summary>
  790. /// <param name="start">起始点</param>
  791. /// <param name="end">结束点</param>
  792. /// <param name="total">总长</param>
  793. /// <returns></returns>
  794. public static float Distance(float start, float end, float total)
  795. {
  796. float distance = 0;
  797. if (start > end) distance = (total - start) + end;
  798. else distance = end - start;
  799. return distance;
  800. }
  801. public static void DoExceptionEX(this DoException ex, WCS_DEVICE Entity)
  802. {
  803. InfoLog.INFO_INFO($"[{Entity.CODE}]--{ex.Message}");
  804. }
  805. /// <summary>
  806. /// 警报执行记录
  807. /// </summary>
  808. /// <param name="ex">警报信息</param>
  809. /// <param name="Entity">发生设备</param>
  810. /// <param name="reportMonitor">是否上报监控</param>
  811. /// <exception cref="Exception"></exception>
  812. public static void WarnExceptionEX(this WarnException ex, WCS_DEVICE Entity, bool reportMonitor = true)
  813. {
  814. InfoLog.INFO_WARN($"[{Entity.CODE}]--{ex.Message}");
  815. if (ex.Message.Contains("The database operation was expected")) return;
  816. LogHelper.AddWCS_EXCEPTION(ex.Message, Entity.CODE, WCS_EXCEPTIONTYPE.无.ToString());
  817. //排除部分频繁触发的异常上报
  818. if (ex.Message.Contains("触发并发管控")) return;
  819. if (reportMonitor)
  820. {
  821. Ltc.Log(ex.GetBaseException().Message);
  822. throw new Exception($"[{Entity.CODE}]--{ex.Message}");
  823. }
  824. }
  825. public static void ExceptionEx(this Exception ex, WCS_DEVICE Entity)
  826. {
  827. InfoLog.INFO_ERROR($"[{Entity.CODE}]--{ex.Message}");
  828. //排除部分频繁触发的异常上报
  829. if (ex.Message.Contains("Collection was modified; enumeration operation may not execute.")) return;
  830. Ltc.Log(ex.GetBaseException().Message);
  831. }
  832. }
  833. /// <summary>
  834. /// 堆垛机货叉/工位
  835. /// </summary>
  836. public enum SrmFork
  837. {
  838. 货叉1 = 0,
  839. 货叉2 = 1,
  840. }
  841. /// <summary>
  842. /// 站台位置信息
  843. /// </summary>
  844. public class StationLocation
  845. {
  846. /// <summary>
  847. /// 所有环穿站台的信息
  848. /// </summary>
  849. public static List<StationLocation> ALLlocations { get; set; } = new List<StationLocation>();
  850. static StationLocation()
  851. {
  852. ALLlocations.AddRange(new List<StationLocation>() {
  853. //new StationLocation("G1187",0,"RGV1",0),
  854. //new StationLocation("G1196",0,"RGV1",0),
  855. //new StationLocation("G1205",0,"RGV1",0),
  856. //new StationLocation("G1214",0,"RGV1",0),
  857. //new StationLocation("G1222",0,"RGV1",0),
  858. //new StationLocation("G1164",0,"RGV1",0),
  859. new StationLocation("G1",486326,"RGV3",1567770),
  860. new StationLocation("G2",693631,"RGV3",1567770),
  861. new StationLocation("G3",789931,"RGV3",1567770),
  862. new StationLocation("G4",961595,"RGV3",1567770),
  863. new StationLocation("G5",1013350,"RGV3",1567770),
  864. new StationLocation("G6",1069938,"RGV3",1567770),
  865. new StationLocation("G7",1126338,"RGV3",1567770),
  866. new StationLocation("G8",1178355,"RGV3",1567770),
  867. new StationLocation("G9",1256875,"RGV3",1567770),
  868. new StationLocation("G10",1313239,"RGV3",1567770),
  869. new StationLocation("G11",1369970,"RGV3",1567770),
  870. });
  871. }
  872. public StationLocation(string station, int location, string plc, int length)
  873. {
  874. Station = station;
  875. Location = location;
  876. PLC = plc;
  877. Length = length;
  878. }
  879. /// <summary>
  880. /// 输送机设备组编号
  881. /// </summary>
  882. public string Station { get; set; }
  883. /// <summary>
  884. /// 输送机在环轨中的位置
  885. /// </summary>
  886. public int Location { get; set; }
  887. /// <summary>
  888. /// 所属RGV组 PLC名称
  889. /// </summary>
  890. public string PLC { get; set; }
  891. /// <summary>
  892. /// 所属环穿轨道的长度
  893. /// </summary>
  894. public int Length { get; set; }
  895. }
  896. /// <summary>
  897. /// 巷道信息
  898. /// </summary>
  899. public class TunnelInfo
  900. {
  901. public WCS_DEVICE Tunnel;
  902. public WCS_DEVICE taskIN;
  903. public Device<ISRM520, ISRM521, ISRM537> SRM;
  904. }
  905. }