RGVWork.cs 9.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231
  1. using DBHelper;
  2. using System;
  3. using System.Linq;
  4. using WCS.Core;
  5. using WCS.Entity;
  6. using WCS.Entity.Protocol;
  7. namespace WCS.Service.Works
  8. {
  9. [WorkTitle(typeof(ProductHandler), "穿梭车", true)]
  10. public class RGVWork : DeviceWork<Device<IRGV521, IRGV520, IRGV523>>
  11. {
  12. protected override void Do(Device<IRGV521, IRGV520, IRGV523> dev)
  13. {
  14. if (dev.Data3.Fault != 0)
  15. {
  16. if (dev.Entity.WakeupOn(5000))
  17. {
  18. WMS.DevInfo(dev.Entity.CODE, dev.Data3.Fault.ToString());
  19. }
  20. }
  21. if (Ltc.Do(dev, v => v.Data2.Trigger != 0))
  22. return;
  23. if (Ltc.Do(dev, v => v.Data.WorkMode != RGVMode.自动))
  24. return;
  25. if (Ltc.Do(dev, v => v.Data.SystemStatus != RGVRunStatus.空闲))
  26. return;
  27. var startStations = Device.Where(v => v.ROUTES.Any(d => d.NEXT.CODE == dev.Entity.CODE))//.Where(v => v.CODE != "2323")
  28. .Select(v => v.Device<IStation521, IStation520>()).ToArray();
  29. startStations = Ltc.Do(startStations, (arr) => arr.Where(v => v.Data.GOODSEND > 0 && v.Data.PH_STATUS).ToArray());
  30. if (dev.Entity.CODE == "RGV1")
  31. startStations = Ltc.Do(startStations, (arr) => arr.Where(v => v.Data.GOODSEND > 0 && v.Data.PH_STATUS && !v.Data.REQUEST).ToArray());
  32. if (startStations.Length == 0)
  33. return;
  34. //startStations = Ltc.Do(startStations, dev, (arr, dev) => arr.Where(v => dev.Entity.ROUTES.Any(d => d.NEXT.CODE == v.Data.GOODSEND.ToString())).ToArray());
  35. //if (startStations.Length == 0)
  36. // return;
  37. startStations = Ltc.Do(startStations, arr => arr.Where(v => v.Data.GOODSEND.ToString() != v.Entity.CODE).ToArray());
  38. if (startStations.Length == 0)
  39. return;
  40. var endEmptys = startStations.Where(v =>
  41. {
  42. var end = Device.Find(v.Data.GOODSEND.ToString());
  43. var next = dev.Entity.GetNext(end.CODE).Device<IStation521>();
  44. var res = next.Data.TASKNUM == 0 && next.Data.PH_STATUS == false;
  45. if (res && end.CODE == "2324")
  46. {
  47. res = Device.Find("2071", "2072", "2073", "2074", "2075", "2076", "2077", "2078", "2079", "2017", "2019", "2022", "2024", "2029").Select(v => v.Device<IStation521>())
  48. .Count(v => v.Data.PH_STATUS == false && v.Data.TASKNUM == 0) > 3;
  49. if (!res)
  50. {
  51. Configs.UploadException(end.CODE, "库前拥堵,RGV暂停入库");
  52. }
  53. }
  54. return res;
  55. }).ToArray();
  56. short taskType = 1;
  57. var st = Ltc.Do(endEmptys, arr => arr.OrderBy(v => v.Entity.CODE == "2182" || v.Entity.CODE == "2181" || v.Entity.CODE == "2081" || v.Entity.CODE == "2325" ? 1 : 2)
  58. .ThenBy(v => v.Data.GetUpdateTime())
  59. .FirstOrDefault());
  60. if (st == null)
  61. {
  62. st = startStations.OrderBy(v => v.Entity.CODE == "2182" || v.Entity.CODE == "2181" || v.Entity.CODE == "2081" || v.Entity.CODE == "2325" ? 1 : 2)
  63. .ThenBy(v => v.Data.GetUpdateTime())
  64. .FirstOrDefault();
  65. taskType = 3;
  66. }
  67. if (taskType == 3)
  68. {
  69. var target = st.Entity.Code();
  70. if (dev.Data.DestPosition != target)
  71. {
  72. dev.Data2.TaskType = taskType;
  73. dev.Data2.TaskID = 1;
  74. dev.Data2.StartPosition = 0;
  75. dev.Data2.DestPosition = short.Parse(st.Entity.CODE);
  76. dev.Data2.Trigger = 1;
  77. }
  78. }
  79. else
  80. {
  81. var next = dev.Entity.GetNext(st.Data.GOODSEND.ToString());
  82. if (next == null)
  83. return;
  84. DB.Do(db =>
  85. {
  86. var task = db.Default.Set<WCS_TASK>().Find(st.Data.TASKNUM);
  87. if (task != null)
  88. {
  89. if (next.CODE == task.ADDRTO)
  90. {
  91. //task.ADDRCURRENT = dev.Entity.CODE;
  92. task.UPDATETIME = DateTime.Now;
  93. db.Default.SaveChanges();
  94. }
  95. }
  96. dev.Data2.TaskType = taskType;
  97. dev.Data2.TaskID = st.Data.TASKNUM;
  98. dev.Data2.StartPosition = short.Parse(st.Entity.CODE);
  99. dev.Data2.DestPosition = next.Code();
  100. dev.Data2.Trigger = 1;
  101. });
  102. }
  103. }
  104. protected override bool SelectDevice(WCS_DEVICE dev)
  105. {
  106. return true;
  107. }
  108. }
  109. [WorkTitle(typeof(ProductHandler), "双工位RGV", true)]
  110. public class 双工位RGV : DeviceWork<Device<IDRGV521, IDRGV520, IDRGV523>>
  111. {
  112. protected override void Do(Device<IDRGV521, IDRGV520, IDRGV523> dev)
  113. {
  114. if (dev.Data3.Fault != 0)
  115. {
  116. if (dev.Entity.WakeupOn(5000))
  117. {
  118. WMS.DevInfo(dev.Entity.CODE, dev.Data3.Fault.ToString());
  119. }
  120. }
  121. if (Ltc.Do(dev, v => v.Data2.Trigger_1 != 0 && v.Data2.Trigger_2 != 0))
  122. return;
  123. if (Ltc.Do(dev, v => v.Data.WorkMode != RGVMode.自动))
  124. return;
  125. if (Ltc.Do(dev, v => v.Data.SystemStatus != RGVRunStatus.空闲))
  126. return;
  127. var startStations = Device.Where(v => v.ROUTES.Any(d => d.NEXT.CODE == dev.Entity.CODE))
  128. .Select(v => v.Device<IStation521, IStation520>()).ToArray();
  129. startStations = Ltc.Do(startStations, (arr) => arr.Where(v => v.Data.GOODSEND > 0 && v.Data.PH_STATUS).ToArray());
  130. if (dev.Entity.CODE == "RGV1")
  131. startStations = Ltc.Do(startStations, (arr) => arr.Where(v => v.Data.GOODSEND > 0 && v.Data.PH_STATUS && !v.Data.REQUEST).ToArray());
  132. if (startStations.Length == 0)
  133. return;
  134. //startStations = Ltc.Do(startStations, dev, (arr, dev) => arr.Where(v => dev.Entity.ROUTES.Any(d => d.NEXT.CODE == v.Data.GOODSEND.ToString())).ToArray());
  135. //if (startStations.Length == 0)
  136. // return;
  137. startStations = Ltc.Do(startStations, arr => arr.Where(v => v.Data.GOODSEND.ToString() != v.Entity.CODE).ToArray());
  138. if (startStations.Length == 0)
  139. return;
  140. var endEmptys = startStations.Where(v =>
  141. {
  142. var end = Device.Find(v.Data.GOODSEND.ToString());
  143. var next = dev.Entity.GetNext(end.CODE).Device<IStation521>();
  144. var res = next.Data.TASKNUM == 0 && next.Data.PH_STATUS == false;
  145. if (res && end.CODE == "2324")
  146. {
  147. res = Device.Find("2071", "2072", "2073", "2074", "2075", "2076", "2077", "2078", "2079", "2017", "2019", "2022", "2024", "2029").Select(v => v.Device<IStation521>())
  148. .Count(v => v.Data.PH_STATUS == false && v.Data.TASKNUM == 0) > 3;
  149. if (!res)
  150. {
  151. Configs.UploadException(end.CODE, "库前拥堵,RGV暂停入库");
  152. }
  153. }
  154. return res;
  155. }).ToArray();
  156. short taskType = 1;
  157. var st = Ltc.Do(endEmptys, arr => arr.OrderBy(v => v.Entity.CODE == "2182" || v.Entity.CODE == "2181" || v.Entity.CODE == "2081" || v.Entity.CODE == "2325" ? 1 : 2)
  158. .ThenBy(v => v.Data.GetUpdateTime())
  159. .FirstOrDefault());
  160. if (st == null)
  161. {
  162. st = startStations.OrderBy(v => v.Entity.CODE == "2182" || v.Entity.CODE == "2181" || v.Entity.CODE == "2081" || v.Entity.CODE == "2325" ? 1 : 2)
  163. .ThenBy(v => v.Data.GetUpdateTime())
  164. .FirstOrDefault();
  165. taskType = 3;
  166. }
  167. if (taskType == 3)
  168. {
  169. var target = st.Entity.Code();
  170. if (dev.Data.DestPosition != target)
  171. {
  172. dev.Data2.TaskType = taskType;
  173. dev.Data2.TaskID = 1;
  174. dev.Data2.StartPosition = 0;
  175. dev.Data2.DestPosition = short.Parse(st.Entity.CODE);
  176. dev.Data2.Trigger = 1;
  177. }
  178. }
  179. else
  180. {
  181. var next = dev.Entity.GetNext(st.Data.GOODSEND.ToString());
  182. if (next == null)
  183. return;
  184. DB.Do(db =>
  185. {
  186. var task = db.Default.Set<WCS_TASK>().Find(st.Data.TASKNUM);
  187. if (task != null)
  188. {
  189. if (next.CODE == task.ADDRTO)
  190. {
  191. //task.ADDRCURRENT = dev.Entity.CODE;
  192. task.UPDATETIME = DateTime.Now;
  193. db.Default.SaveChanges();
  194. }
  195. }
  196. dev.Data2.TaskType = taskType;
  197. dev.Data2.TaskID = st.Data.TASKNUM;
  198. dev.Data2.StartPosition = short.Parse(st.Entity.CODE);
  199. dev.Data2.DestPosition = next.Code();
  200. dev.Data2.Trigger = 1;
  201. });
  202. }
  203. }
  204. protected override bool SelectDevice(WCS_DEVICE dev)
  205. {
  206. return true;
  207. }
  208. }
  209. }