RGVWorks.cs 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537
  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.Entity.Protocol.SRM;
  10. using WCS.Service.Extensions;
  11. using WCS.Service.Handlers;
  12. using WCS.Service.Helpers;
  13. using WCS.Service.Log;
  14. namespace WCS.Service.Works.RGV
  15. {
  16. [WorkTitle(typeof(RGVHandler), "直穿RGV")]
  17. public class 直穿RGV : DeviceWork<RGVDevice>
  18. {
  19. private readonly string ConvGroup_1030 = "G1030";
  20. private readonly string RGV8 = "RGV8";
  21. protected override void Do(RGVDevice rgv)
  22. {
  23. rgv.EX(rgv =>
  24. {
  25. //RGV是自动且空闲的
  26. if (rgv.Data2.WorkMode != RGVMode.自动) throw new DoException($"{rgv.Data2.WorkMode}");
  27. if (rgv.Data2.SystemStatus != RGVRunStatus.空闲) throw new DoException($"{rgv.Data2.SystemStatus}");
  28. if (rgv.Data.Trigger_1 != rgv.Data2.Trigger_1) throw new WarnException("凭证好不一致");
  29. if (rgv.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.光电)) throw new DoException("RGV有光电,无法执行任务");
  30. //RGV状态为 RGV到站&&任务完成 时程序认为RGV当前不在取货点
  31. if (rgv.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.RGV到站) && rgv.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.任务完成))
  32. {
  33. //下达一个目标为1030的移动任务
  34. rgv.Data.TaskID_1 = 1030;
  35. rgv.Data.DestPosition_1 = 1030;
  36. rgv.Data.TaskType_1 = RGVTaskType.移动;
  37. rgv.Data.Trigger_1++;
  38. }
  39. var obj = Device.Find(ConvGroup_1030).Create<StationDeviceGroup>();
  40. obj.WhetherToExecute();
  41. //筛选出有任务号和起始及目标地址的设备
  42. var dev = obj.RGVGetTaskedDevice() ?? throw new WarnException("无可用任务");
  43. var taskids = dev.Select(v => v.Data2.Tasknum);
  44. DB.Do(db =>
  45. {
  46. var tasks = db.Default.Set<WCS_TASK>().Where(p => taskids.Contains(p.ID));
  47. if (tasks.GroupBy(p => p.TaskGroupKey).Count() > 1)
  48. throw new WarnException("任务组ID不一致");
  49. if (!tasks.GroupBy(p => p.TaskGroupKey).Any())
  50. throw new WarnException("无任务组ID");
  51. var gw1 = obj.Items.ToArray()[0];
  52. var gw2 = obj.Items.ToArray()[1];
  53. if (gw1.Data2.Tasknum != 0 && gw2.Data2.Tasknum != 0)
  54. {
  55. if (gw1.Data2.Goodsend != gw2.Data2.Goodsend) throw new WarnException($"{obj.Entity.CODE}目标地址不一致");
  56. }
  57. rgv.Data.TaskID_1 = gw1.Data2.Tasknum;
  58. rgv.Data.TaskID_2 = gw2.Data2.Tasknum;
  59. if (gw1.Data2.Tasknum != 0)
  60. {
  61. rgv.Data.StartPosition_1 = gw1.Entity.CODE.ToShort();
  62. rgv.Data.DestPosition_1 = gw1.Data2.Goodsend;
  63. }
  64. else
  65. {
  66. rgv.Data.StartPosition_1 = gw1.Entity.CODE.ToShort();
  67. rgv.Data.DestPosition_1 = gw2.Data2.Goodsend;
  68. }
  69. rgv.Data.Trigger_1++;
  70. foreach (var task in tasks)
  71. {
  72. task.CreateStatusLog(db, "RGV开始执行", this.GetType());
  73. }
  74. db.Default.SaveChanges();
  75. });
  76. });
  77. }
  78. protected override bool SelectDevice(WCS_DEVICE dev)
  79. {
  80. return dev.CODE == RGV8;
  81. }
  82. }
  83. [WorkTitle(typeof(RGVHandler), "涂布环穿")]
  84. public class 涂布环穿 : DeviceWork<RGVDevice>
  85. {
  86. protected override void Do(RGVDevice obj)
  87. {
  88. //11号站台是取货点,但不是待命点,如需取货,从九号站台调车
  89. //2号站台是一个待命点,但是为了保证入库取货效率,所有后面会跟一个车
  90. //如果3号站台的小车拦住了后一个小车的放货任务,检测一次最近的空车距离值,如果大于或等于618500并且小于被拦住小车的位置值再进行调车,用于避免无效空跑
  91. obj.EX(rgvDevice =>
  92. {
  93. //状态上抛
  94. DeciceStateHelper.StatusCheck(obj.Entity.CODE, obj.Data2.WorkMode.ToString());
  95. if (rgvDevice.Data2.Trigger_1 != rgvDevice.Data.Trigger_1) throw new WarnException($"等待执行任务{rgvDevice.Data2.TaskID_1}--{rgvDevice.Data2.TaskID_2}");
  96. if (rgvDevice.Data2.WorkMode != RGVMode.自动) throw new DoException(rgvDevice.Data2.WorkMode.ToString());
  97. if (rgvDevice.Data2.SystemStatus != RGVRunStatus.空闲) throw new DoException(rgvDevice.Data2.SystemStatus.ToString());
  98. rgvDevice.End();
  99. //RGV当前是否刚刚完成取货任务,等待放货
  100. if (rgvDevice.IsPut())
  101. {
  102. if (!rgvDevice.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.光电)) throw new WarnException("RGV无光电,无法放货,请检查实际情况");
  103. var taskids = new List<int>() { rgvDevice.Data2.TaskID_1, rgvDevice.Data2.TaskID_2 };
  104. List<WCS_TASK> tasks = new List<WCS_TASK>();
  105. //取小车上的任务
  106. DB.Do(db =>
  107. {
  108. tasks = db.Default.Set<WCS_TASK>().Where(p => taskids.Contains(p.ID)).ToList();
  109. });
  110. if (tasks.GroupBy(p => p.TaskGroupKey).Count() > 1)
  111. throw new WarnException("任务组ID不一致");
  112. if (!tasks.GroupBy(p => p.TaskGroupKey).Any())
  113. throw new WarnException("无任务组ID");
  114. var destStation = Device.Find(tasks.FirstOrDefault()!.ADDRNEXT).Create<StationDeviceGroup>();
  115. rgvDevice.Put(destStation, rgvDevice.Data2.TaskID_1, rgvDevice.Data2.TaskID_2);
  116. rgvDevice.Add();
  117. return;
  118. }
  119. //当前有rgv的取货站台
  120. var pickStation = rgvDevice.CurrentStation();
  121. //RGV是否在任何一个站台
  122. if (pickStation != null)
  123. {
  124. //是否是取货站台
  125. if (pickStation.Entity.Is(DF.涂布RGV取货设备组))
  126. {
  127. // 筛选出有任务号和起始及目标地址的设备
  128. var devise = pickStation.RGVGetTaskedDevice();
  129. //是否需要取货
  130. if (devise is { Count: > 0 } && pickStation.IsPickUp(rgvDevice))
  131. {
  132. if (rgvDevice.Data.TaskID_1 != pickStation.Entity.CODE.Replace("G", "").ToShort()) throw new WarnException($"目标站台{rgvDevice.Data.TaskID_1}与当前站台{pickStation.Entity.CODE.Replace("G", "").ToShort()}不一致");
  133. if (rgvDevice.Data2.TaskType_1 != RGVTaskType.移动) throw new WarnException($"RGV正在执行{rgvDevice.Data2.TaskType_1}");
  134. if (rgvDevice.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.光电)) throw new WarnException("RGV有光电,无法取货,请检查实际情况");
  135. if (!rgvDevice.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.RGV到站)) throw new WarnException("RGV无到站状态,请检查RGV实际状态");
  136. var taskids = devise.Select(v => v.Data2.Tasknum);
  137. List<WCS_TASK> tasks = new List<WCS_TASK>();
  138. //开始下达取货任务
  139. DB.Do(db =>
  140. {
  141. tasks = db.Default.Set<WCS_TASK>().Where(p => taskids.Contains(p.ID)).ToList();
  142. });
  143. if (tasks.GroupBy(p => p.TaskGroupKey).Count() > 1)
  144. throw new WarnException("任务组ID不一致");
  145. if (!tasks.GroupBy(p => p.TaskGroupKey).Any())
  146. throw new WarnException("无任务组ID");
  147. var gw1 = pickStation.Items.ToArray()[0];
  148. var gw2 = pickStation.Items.ToArray()[1];
  149. if (gw1.Data2.Tasknum != 0 && gw2.Data2.Tasknum != 0)
  150. {
  151. if (gw1.Data2.Goodsend != gw2.Data2.Goodsend) throw new WarnException($"{rgvDevice.Entity.CODE}目标地址不一致");
  152. }
  153. InfoLog.INFO_RGVINFO($"[{rgvDevice.Entity.CODE}]--写入RGV取货任务-开始:{rgvDevice.Data.TaskID_1},{rgvDevice.Data.TaskID_2},{rgvDevice.Data.TaskType_1},{rgvDevice.Data.DestPosition_1},{rgvDevice.Data.Trigger_1}");
  154. rgvDevice.Data.TaskID_1 = gw1.Data2.Tasknum;
  155. rgvDevice.Data.TaskID_2 = gw2.Data2.Tasknum;
  156. rgvDevice.Data.TaskType_1 = RGVTaskType.取货;
  157. rgvDevice.Data.DestPosition_1 = pickStation.Entity.CODE.Replace("G", "").ToShort();
  158. InfoLog.INFO_RGVINFO($"[{rgvDevice.Entity.CODE}]--写入RGV取货任务-结束:{rgvDevice.Data.TaskID_1},{rgvDevice.Data.TaskID_2},{rgvDevice.Data.TaskType_1},{rgvDevice.Data.DestPosition_1},{rgvDevice.Data.Trigger_1}");
  159. rgvDevice.Data.Trigger_1++;
  160. DB.Do(db =>
  161. {
  162. foreach (var task in tasks)
  163. {
  164. task.CreateStatusLog(db, $"取货任务下达至{rgvDevice.Entity.CODE}", this.GetType());
  165. }
  166. db.Default.SaveChanges();
  167. });
  168. rgvDevice.Add();
  169. return;
  170. }
  171. if (rgvDevice.RGVList.Count + 1 != 6)//有小车进入维修站时启用该逻辑,避免在正常使用时影响效率,RGVList把自身排除在外了所以需要+1
  172. {
  173. //var stationList = rgvDevice.LocationList.Where(v => v.Entity.Is(DF.涂布RGV取货设备组)).Where(v => v.RGVGetTaskedDevice().Any())
  174. // .Where(v =>
  175. // {
  176. // if (v.CurrentRGV() == null) return true;
  177. // return false;
  178. // });
  179. //if (stationList != null)
  180. //{
  181. // var station11 = stationList.MinBy(rgvDevice.Distance);
  182. // //该站台到当前小车的范围中没有车
  183. // if (rgvDevice.RGVList.Any(v => station11!.Position <= v.Position && rgvDevice.Position > v.Position))
  184. // {
  185. // rgvDevice.Move(station11);
  186. // return;
  187. // }
  188. //}
  189. }
  190. if (pickStation.Entity.CODE == "G9")
  191. {
  192. //九站台的小车需要额外检测一下11站台是否需要取货
  193. var station11 = Device.Find("G11").Create<StationDeviceGroup>();
  194. var station11Dev = station11.RGVGetTaskedDevice();
  195. if (station11Dev != null && station11Dev.Count > 0)
  196. {
  197. rgvDevice.Move(station11);
  198. rgvDevice.Add();
  199. return;
  200. }
  201. }
  202. //找到自己的后一个小车
  203. var afterRgv = rgvDevice.After();
  204. //自己是否阻挡了该小车
  205. if (afterRgv.Data2.WorkMode == RGVMode.自动 && afterRgv.Data2.SystemStatus != RGVRunStatus.空闲 && rgvDevice.StopedByMe(afterRgv))
  206. {
  207. switch (pickStation.Entity.CODE)
  208. {
  209. case "G2":
  210. {
  211. if (rgvDevice.RGVList.Count + 1 != 6) break;
  212. //此站台因需要进行排队,因此是否需要赶车取决于是否拦住了两个小车的任务
  213. var afterRgv1 = afterRgv.After();
  214. //如果是空闲或者没有拦住他,就不执行赶车
  215. if (afterRgv1.Data2.WorkMode == RGVMode.自动 && (afterRgv1.Data2.SystemStatus == RGVRunStatus.空闲 || !afterRgv.StopedByMe(afterRgv1))) return;
  216. break;
  217. }
  218. case "G3":
  219. {
  220. if (rgvDevice.RGVList.Count + 1 != 6) break;
  221. //为了减少空跑,需要被阻拦的小车后面的小车任务类型为移动并且位置值要大于618500小于被阻拦小车的位置值
  222. var afterRgv1 = afterRgv.After();
  223. if (afterRgv1.Data2.WorkMode == RGVMode.自动 && afterRgv.Data2.TaskType_1 != RGVTaskType.移动 && !(afterRgv1.Position < afterRgv.Position && afterRgv1.Position > 618500)) return;
  224. break;
  225. }
  226. }
  227. //找到当前所在站台的下一个取货点
  228. var beforeStation = Device.Where(v => v.Is(DF.涂布RGV取货设备组) && v.CODE != pickStation.Entity.CODE)
  229. .Select(v => v.Create<StationDeviceGroup>()).MinBy(v => pickStation.Distance(v));
  230. //写入移动任务
  231. rgvDevice.Move(beforeStation);
  232. rgvDevice.Add();
  233. return;
  234. }
  235. if (pickStation.Entity.CODE == "G11")
  236. {
  237. rgvDevice.Move(Device.Find("G2").Create<StationDeviceGroup>());
  238. rgvDevice.Add();
  239. return;
  240. }
  241. }
  242. //是否在一个放货站台
  243. if (pickStation.Entity.Is(DF.涂布RGV放货设备组))
  244. {
  245. pickStation = rgvDevice.BeforeStation();
  246. rgvDevice.Move(pickStation);
  247. rgvDevice.Add();
  248. return;
  249. }
  250. }
  251. //此时RGV即没有等待执行的放货任务,也不在任何一个取货点,因此需要调往最近的一个取货点
  252. //找到距离这个RGV最近的一个取货点
  253. //必须所有RGV都是空闲状态时才可以进行初始化
  254. if (rgvDevice.RGVList.Any(v => v.Data2.SystemStatus != RGVRunStatus.空闲)) return;
  255. pickStation = rgvDevice.BeforeStation();
  256. rgvDevice.Move(pickStation);
  257. rgvDevice.Add();
  258. });
  259. }
  260. protected override bool SelectDevice(WCS_DEVICE dev)
  261. {
  262. return dev.Is(DF.涂布RGV);
  263. }
  264. }
  265. [WorkTitle(typeof(RGVHandler), "BOPP环穿")]
  266. public class BOPP环穿 : DeviceWork<RGVDevice>
  267. {
  268. protected override void Do(RGVDevice obj)
  269. {
  270. obj.EX(obj =>
  271. {
  272. //状态上抛
  273. DeciceStateHelper.StatusCheck(obj.Entity.CODE, obj.Data2.WorkMode.ToString());
  274. if (obj.Data2.Trigger_1 != obj.Data.Trigger_1) throw new WarnException($"等待执行任务{obj.Data2.TaskID_1}--{obj.Data2.TaskID_2}");
  275. if (obj.Data2.WorkMode != RGVMode.自动) throw new DoException(obj.Data2.WorkMode.ToString());
  276. if (obj.Data2.SystemStatus != RGVRunStatus.空闲) throw new DoException(obj.Data2.SystemStatus.ToString());
  277. #region 取货完成小车直接移动至12号站台
  278. if (obj.IsPut())//RGV当前是否刚刚完成取货任务,等待放货移动
  279. {
  280. if (obj.Data.TaskType_1 != RGVTaskType.取货) throw new WarnException($"当前任务类型必须为取货任务");
  281. if (obj.Data2.WorkMode != RGVMode.自动) throw new WarnException($"RGV状态{obj.Data2.WorkMode},无法执行放货移动任务");
  282. if (obj.Data2.SystemStatus != RGVRunStatus.空闲) throw new WarnException($"rgv状态为{obj.Data2.SystemStatus},无法执行放货移动任务");
  283. if (!obj.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.光电)) throw new WarnException("RGV无光电,无法执行放货移动任务");
  284. var addr = Device.Find("G12").Create<StationDeviceGroup>();
  285. if (obj.Data2.TaskID_1 == addr.Entity.CODE.GetShortCode() && obj.Data.TaskType_1 == RGVTaskType.移动)
  286. {
  287. InfoLog.INFO_RGVINFO($"{obj.Entity.CODE}]--已有目标地址相同的移动任务");
  288. return;
  289. }
  290. InfoLog.INFO_RGVINFO($"[{obj.Entity.CODE}]--写入RGV放货移动任务-开始:{obj.Data.TaskID_1},{obj.Data.TaskType_1},{obj.Data.DestPosition_1},{obj.Data.Trigger_1}");
  291. obj.Data.TaskType_1 = RGVTaskType.移动;
  292. obj.Data.DestPosition_1 = addr.Entity.CODE.GetShortCode();
  293. obj.Data.Trigger_1++;
  294. InfoLog.INFO_RGVINFO($"[{obj.Entity.CODE}]--写入RGV移动任务-结束:{obj.Data.TaskID_1},{obj.Data.TaskType_1},{obj.Data.DestPosition_1},{obj.Data.Trigger_1}");
  295. return;
  296. }
  297. #endregion 取货完成小车直接移动至12号站台
  298. var pickStation = obj.CurrentStation();
  299. //RGV是否在任何一个站台
  300. if (pickStation != null)
  301. {
  302. //是否是取货站台
  303. if (pickStation.Entity.Is(DF.BOPPRGV取货设备组))
  304. {
  305. // var a = Items.Where(v => v.Data2.Status.HasFlag(IstationStatus.光电状态) && v.Data2.Tasknum > 10000)
  306. // .Where(v => v.Entity.CODE.ToShort() != v.Data2.Goodsend && v.Data2.Goodsend != 0)
  307. //.ToList();
  308. if (pickStation.Entity.CODE == "G19")
  309. {
  310. var pickStations = Device.Find("G23").Create<StationDeviceGroup>().RGVGetTaskedDevice();
  311. if (pickStations != null && pickStations.Any() && !obj.RGVList.Any(v => v.Data2.SystemStatus != RGVRunStatus.空闲 && v.Data2.DestPosition_1 == 23))
  312. {
  313. obj.Move(Device.Find("G23").Create<StationDeviceGroup>());
  314. return;
  315. }
  316. }
  317. // 筛选出有任务号和起始及目标地址的设备
  318. var devs = pickStation.RGVGetTaskedDevice();
  319. //是否需要取货
  320. if (devs != null && devs.Count() > 0)
  321. {
  322. if (obj.Data2.TaskType_1 != RGVTaskType.移动) throw new WarnException($"RGV正在执行{obj.Data2.TaskType_1}");
  323. if (obj.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.光电)) throw new WarnException("RGV有光电,无法取货,请检查实际情况");
  324. if (!obj.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.RGV到站)) throw new WarnException("RGV无到站状态,请检查RGV实际状态");
  325. var taskids = devs.Select(v => v.Data2.Tasknum);
  326. //开始下达取货任务
  327. DB.Do(db =>
  328. {
  329. var tasks = db.Default.Set<WCS_TASK>().Where(p => taskids.Contains(p.ID));
  330. if (tasks.GroupBy(p => p.TaskGroupKey).Count() > 1)
  331. throw new WarnException("任务组ID不一致");
  332. if (!tasks.GroupBy(p => p.TaskGroupKey).Any())
  333. throw new WarnException("无任务组ID");
  334. var gw1 = pickStation.Items.ToArray()[0];
  335. var gw2 = pickStation.Items.ToArray()[1];
  336. //if (gw1.Data2.Tasknum != 0 && gw2.Data2.Tasknum != 0)
  337. //{
  338. // if (gw1.Data2.Goodsend != gw2.Data2.Goodsend) throw new WarnException($"{obj.Entity.CODE}目标地址不一致");
  339. //}
  340. obj.Pick(pickStation, gw1.Data2.Tasknum, gw2.Data2.Tasknum);
  341. foreach (var task in tasks)
  342. {
  343. task.CreateStatusLog(db, $"取货任务下达至{obj.Entity.CODE}", this.GetType());
  344. }
  345. });
  346. return;
  347. }
  348. int needToMove = obj.RGVList.Count(v => v.Data2.TaskType_1 == RGVTaskType.放货 && v.Position > StationLocation.ALLlocations.FirstOrDefault(v => v.Station == "G19").Location && v.Position < StationLocation.ALLlocations.FirstOrDefault(v => v.Station == "G23").Location);
  349. if (pickStation.Entity.CODE == "G23" && needToMove >= 2)
  350. {
  351. obj.Move(Device.Find("G19").Create<StationDeviceGroup>());
  352. return;
  353. }
  354. //计算当前RGV拦住小车的数量
  355. var max = obj.RGVList.Count(v => v.Data2.WorkMode == RGVMode.自动 && v.Data2.SystemStatus != RGVRunStatus.空闲 && obj.StopedByMe(v));
  356. if (pickStation.Entity.CODE == "G19" && max >= 2)
  357. {
  358. obj.Move(Device.Find("G23").Create<StationDeviceGroup>());
  359. }
  360. }
  361. //是否在一个放货站台
  362. if (pickStation.Entity.Is(DF.BOPPRGV放货设备组))
  363. {
  364. #region 12站台
  365. if (pickStation.Entity.CODE == "G12")
  366. {
  367. #region 上一个任务为移动
  368. if (obj.Data.TaskType_1 == RGVTaskType.移动)
  369. {
  370. if (obj.Data2.WorkMode != RGVMode.自动) throw new WarnException($"RGV状态{obj.Data2.WorkMode},无法分配巷道");
  371. if (obj.Data2.SystemStatus != RGVRunStatus.空闲) throw new WarnException($"rgv状态为{obj.Data2.SystemStatus},无法分配巷道");
  372. if (!obj.Data2.Status_1.HasFlag(WCS.Entity.Protocol.RGVStatus.光电)) throw new WarnException("RGV无光电,无法分配巷道");
  373. #region 开始分配巷道
  374. var taskIds = new List<int>() { obj.Data2.TaskID_1, obj.Data2.TaskID_2 };
  375. taskIds = taskIds.Where(v => v > 10000).ToList(); //筛选出有效的任务
  376. DB.Do(db =>
  377. {
  378. var taskList = db.Default.Set<WCS_TASK>().Where(v => taskIds.Contains(v.ID)).ToList();
  379. var task = taskList.FirstOrDefault() ?? throw new WarnException($"RGV无可分配巷道任务"); ;
  380. var taskCount = db.Default.Set<WCS_TASK>().Count(v => v.TaskGroupKey == task.TaskGroupKey && v.TYPE == TaskType.入库);
  381. //开始检查任务数是否匹配
  382. if (taskList.Count != taskCount) throw new WarnException($"可执行数{taskList.Count},任务组任务数{taskCount},数量不匹配,{task.ID}-{task.TaskGroupKey}");
  383. var res = WMS.GetTunnelList(taskList.Select(v => v.WMSTASK.ToString()).ToList(), obj.Entity.CODE);
  384. if (string.IsNullOrEmpty(res.TunnelNum)) throw new WarnException($"WMS未返回巷道");
  385. var tunnelNo = res.TunnelNum.Split(',').Select(v => "TY" + v).ToList();
  386. var tunnels = Device.Where(v => tunnelNo.Contains(v.CODE)).ToList();
  387. var tunnelInfos = new List<TunnelInfo>();
  388. foreach (var item in tunnels)
  389. {
  390. //当前巷道的取货点
  391. var allIn = Device.Where(v => v.Is(DF.SRMBOPP取货))
  392. .Where(v => v.ROUTES.Any(p => p.NEXT == item)) //下一个点为当前巷道的取货点
  393. .Select(v => v.CODE)
  394. .ToList();
  395. //下一个目标地址包含取货点的设备,此时获得的数据是旋转台
  396. var turntable = Device.Where(v => v.IsConv() && v.ROUTES.Any(p => p.NEXT != null && allIn.Contains(p.NEXT.CODE))).Select(v => v.CODE);
  397. //获得RGV的交货点
  398. StationDevice rgvDeliveryPoint = null;
  399. if (item.CODE == "TY1")
  400. {
  401. rgvDeliveryPoint = Device.Where(v => v.IsConv() && v.ROUTES.Any(p => p.NEXT != null && turntable.Contains(p.NEXT.CODE)))
  402. .Select(v => v.Create<StationDevice>()) //取所有可以到达取货点设备的信息
  403. .Where(v => v.Data3.Status.HasFlag(StationStatus.自动))//筛选出空闲的路径点,此处因输送机都是一个动力,因此可以先找路径点再找设备组
  404. .Distinct()
  405. .FirstOrDefault();//去一次重
  406. }
  407. else
  408. {
  409. rgvDeliveryPoint = Device.Where(v => v.IsConv() && v.ROUTES.Any(p => p.NEXT != null && turntable.Contains(p.NEXT.CODE)))
  410. .Select(v => v.Create<StationDevice>()) //取所有可以到达取货点设备的信息
  411. .Where(v => !v.Data3.Status.HasFlag(StationStatus.运行状态位)
  412. && !v.Data2.Status.HasFlag(IstationStatus.光电状态)
  413. && v.Data2.Tasknum < 10000
  414. && v.Data3.Status.HasFlag(StationStatus.自动))//筛选出空闲的路径点,此处因输送机都是一个动力,因此可以先找路径点再找设备组
  415. .Distinct()
  416. .FirstOrDefault();//去一次重
  417. }
  418. if (rgvDeliveryPoint == null) continue;
  419. var taskInStation = Device.Where(p => p.CODE.StartsWith("G") && p.DEVICEGROUP.Any(d => d.MEMBER == rgvDeliveryPoint.Entity)).MinBy(p => p.CODE);
  420. //只能有一组任务的下一个地址是交货点
  421. if (db.Default.Set<WCS_TASK>().Any(v => v.ADDRNEXT == taskInStation.CODE && v.STATUS < TaskStatus.已完成)) continue;
  422. //RGV是否有正在前往这个地址的任务
  423. var rgvList = Device.Where(v => v.Is(DF.BOPPRGV)).Select(v => v.Create<RGVDevice>());
  424. var rgvTaskCount = ProtocolProxy.YGWMS150Redis.Get("BoppRgvTaskCount").ToInt();
  425. if (rgvList.Count(v => (!v.Data2.SystemStatus.HasFlag(WCS.Entity.Protocol.RGV.RGVRunStatus.空闲) || !v.Data2.WorkMode.HasFlag(WCS.Entity.Protocol.RGV.RGVMode.自动))
  426. && v.Data2.TaskType_1 == WCS.Entity.Protocol.RGV.RGVTaskType.放货
  427. && v.Data2.DestPosition_1 == taskInStation?.CODE.Replace("G", "").ToShort()) > rgvTaskCount) continue;
  428. tunnelInfos.Add(new TunnelInfo
  429. {
  430. Tunnel = item,
  431. taskIN = taskInStation, //找到放货点设备所在组
  432. SRM = Device.Where(p => p.IsSC()).FirstOrDefault(p => item.ROUTES.Any(d => d.NEXT.CODE == p.CODE)).Create<SRMDevice>()
  433. });
  434. }
  435. //筛选出优先级最高的可用巷道
  436. var tunnelInfo = tunnelInfos.Where(v => { try { return (v.SRM.Data3.SCAlarm == 0 && v.SRM.Data2.SRMMode == SCMode.远程) || v.SRM.Entity.CODE == "SRM1"; } catch { return false; } }).MinBy(v => tunnelNo.IndexOf(v.Tunnel.CODE));
  437. if (tunnelInfo == null) throw new WarnException("无可用巷道");
  438. //开始变更任务信息
  439. foreach (var item in taskIds)
  440. {
  441. var task1 = taskList.FirstOrDefault(p => p.ID == item);
  442. if (task == null) throw new WarnException($"WCS无该任务{item}--{obj.Entity.CODE}");
  443. task1.DEVICE = tunnelInfo.SRM.Entity.CODE;
  444. task1.TUNNEL = tunnelInfo.Tunnel.CODE;
  445. task1.ADDRNEXT = tunnelInfo.taskIN.CODE;
  446. task1.TaskGroupKey = res.WMSTaskGroupKey;
  447. task1.ADDRTO = task1.DEVICE;
  448. var msg = $"下达从G12移动至{tunnelInfo.taskIN.CODE}的PLC指令。同时将任务分配至[{task1.TUNNEL}]-[{task1.DEVICE}]";
  449. task1.CreateStatusLog(db, msg, this.GetType());
  450. }
  451. db.Default.SaveChanges();
  452. obj.Data.TaskType_1 = RGVTaskType.放货;
  453. obj.Data.DestPosition_1 = tunnelInfo.taskIN.CODE.Replace("G", "").ToShort();
  454. obj.Data.Trigger_1++;
  455. });
  456. #endregion
  457. }
  458. #endregion 上一个任务为移动
  459. #region 上一个任务为放货
  460. else if (obj.Data.TaskType_1 == RGVTaskType.放货)
  461. {
  462. obj.Move(Device.Find("G19").Create<StationDeviceGroup>());
  463. }
  464. #endregion 上一个任务为放货
  465. return;
  466. }
  467. #endregion 12站台
  468. #region 非12站台
  469. obj.Move(Device.Find("G19").Create<StationDeviceGroup>());
  470. #endregion 非12站台
  471. }
  472. return;
  473. }
  474. //此时RGV即没有等待执行的放货任务,也不在任何一个取货点,因此需要调往最近的一个取货点
  475. //找到距离这个RGV最近的一个取货点
  476. //必须所有RGV都是空闲状态时才可以进行初始化
  477. if (obj.RGVList.Any(v => v.Data2.SystemStatus != RGVRunStatus.空闲 || v.Data2.WorkMode != RGVMode.自动)) return;
  478. obj.Move(Device.Find("G19").Create<StationDeviceGroup>());
  479. });
  480. }
  481. protected override bool SelectDevice(WCS_DEVICE dev)
  482. {
  483. return dev.Is(DF.BOPPRGV);
  484. }
  485. }
  486. }