You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 

619 lines
23 KiB

  1. ////#define test
  2. //using BPA.Message;
  3. //using HBLConsole.Communication;
  4. //using HBLConsole.Factory;
  5. //using HBLConsole.Interface;
  6. //using HBLConsole.Model;
  7. //using HBLConsole.Service;
  8. //using System;
  9. //using System.Collections.Generic;
  10. //using System.Linq;
  11. //using System.Text;
  12. //using System.Threading;
  13. //using System.Threading.Tasks;
  14. //using BPA.Message.Enum;
  15. //using BPA.Models;
  16. //namespace HBLConsole.Business.Devices
  17. //{
  18. // public class MORKS : IControl
  19. // {
  20. // private volatile static MORKS _Instance;
  21. // public static MORKS GetInstance => _Instance ?? (_Instance = new MORKS());
  22. // private MORKS() { }
  23. // public GVL.MORKS mORKS { get; set; } = new GVL.MORKS();
  24. // public void Init()
  25. // {
  26. // //模拟订单
  27. // SimOrder();
  28. // Test();
  29. // }
  30. // public void ConnectOk()
  31. // {
  32. // WriteRecipeBoms();
  33. // ReadData();
  34. // Main();
  35. // //ResetProgram();
  36. // MessageLog.GetInstance.Show("MORKS 设备初始化完成");
  37. // }
  38. // /// <summary>
  39. // /// 测试程序
  40. // /// </summary>
  41. // private void Test()
  42. // {
  43. //#if test
  44. // ThreadManagerment.GetInstance.StartLong(new Action(() =>
  45. // {
  46. // while (Json<MorkOrderPushPar>.GetInstance.Base.morkOrderPushes.Count > 0)
  47. // {
  48. // var result = Json<MorkOrderPushPar>.GetInstance.Base.morkOrderPushes.ElementAt(0);
  49. // SimpleFactory.GetInstance.OrderChanged(result.OrderPush.SuborderId, ORDER_STATUS.COOKING);
  50. // MessageLog.GetInstance.Show($"{result.OrderPush.GoodsName},{ORDER_STATUS.COOKING}");
  51. // Thread.Sleep(5000);
  52. // SimpleFactory.GetInstance.OrderChanged(result.OrderPush.SuborderId, ORDER_STATUS.COMPLETED_COOK);
  53. // MessageLog.GetInstance.Show($"{result.OrderPush.GoodsName},{ORDER_STATUS.COMPLETED_COOK}");
  54. // Thread.Sleep(5000);
  55. // SimpleFactory.GetInstance.OrderChanged(result.OrderPush.SuborderId, ORDER_STATUS.COMPLETED_TAKE);
  56. // MessageLog.GetInstance.Show($"{result.OrderPush.GoodsName},{ORDER_STATUS.COMPLETED_TAKE}");
  57. // Thread.Sleep(5000);
  58. // Json<MorkOrderPushPar>.GetInstance.Base.morkOrderPushes.RemoveAt(0);
  59. // }
  60. // Thread.Sleep(500);
  61. // }), "test");
  62. //#endif
  63. // }
  64. // private void Readbool(ushort startAddress, ushort len, Action<bool[]> action)
  65. // {
  66. // object result;
  67. // result = ModbusTcpHelper.GetInstance.Read(startAddress, ReadType.Coils, len);
  68. // if (result != null)
  69. // {
  70. // if (result is bool[] bools)
  71. // {
  72. // if (bools.Length == len)
  73. // {
  74. // action(bools);
  75. // }
  76. // }
  77. // }
  78. // }
  79. // /// <summary>
  80. // /// 复位程序
  81. // /// </summary>
  82. // private void ResetProgram()
  83. // {
  84. // ThreadManagerment.GetInstance.StartLong(new Action(() =>
  85. // {
  86. // if (RTrig.GetInstance("ResetProgram").Start(mORKS.DeviceIniting))
  87. // {
  88. // ThreadManagerment.GetInstance.StopTask("MainTask", new Action(() =>
  89. // {
  90. // mORKS.AllowRun = false;
  91. // TakeBowlId = string.Empty;
  92. // IngredientsCompleteId = string.Empty;
  93. // CookNodelId = new string[6] { string.Empty, string.Empty, string.Empty, string.Empty, string.Empty, string.Empty, };
  94. // mORKS.RobotTaskInterlock = false;
  95. // OutMealId = string.Empty;
  96. // mORKS.TakeBowlInterlock = false;
  97. // mORKS.TakeNoodleInterlock = false;
  98. // mORKS.OutNoodleing = false;
  99. // Main();
  100. // }));
  101. // }
  102. // Thread.Sleep(10);
  103. // }), "ResetProgram");
  104. // }
  105. // /// <summary>
  106. // /// 数据读取
  107. // /// </summary>
  108. // public void ReadData()
  109. // {
  110. // ThreadManagerment.GetInstance.StartLong(new Action(() =>
  111. // {
  112. // Readbool(323, 3, new Action<bool[]>((bools) =>
  113. // {
  114. // mORKS.RobotTakeNoodle = bools[0];
  115. // mORKS.RobotOutMeal = bools[1];
  116. // mORKS.MoveTurntable = bools[2];
  117. // }));
  118. // Readbool(1120, 16, new Action<bool[]>((bools) =>
  119. // {
  120. // mORKS.InitComplete = bools[0];
  121. // mORKS.TakeBowlIdle = bools[1];
  122. // mORKS.TemperatureReached = bools[2];
  123. // mORKS.AllowFallNoodle = bools[3];
  124. // mORKS.RbTakeNoodleComplete = bools[4];
  125. // mORKS.RbFallNoodleComplete = bools[5];
  126. // mORKS.RbOutMealComplete = bools[6];
  127. // mORKS.RobotIdle = bools[7];
  128. // mORKS.TakeMealDetect = bools[8];
  129. // mORKS.MissingBowl = bools[9];
  130. // mORKS.DeviceIniting = bools[10];
  131. // mORKS.TurntableLowerLimit = bools[11];
  132. // mORKS.MissingBowlSignal2 = bools[12];
  133. // mORKS.TurntableUpLimit = bools[13];
  134. // mORKS.TurntableMoveInPlace = bools[15];
  135. // }));
  136. // Readbool(1136, 6, new Action<bool[]>((bools) =>
  137. // {
  138. // for (int i = 0; i < 6; i++)
  139. // {
  140. // mORKS.NoodleCookerStatus[i] = bools[i];
  141. // }
  142. // }));
  143. // Readbool(1144, 6, new Action<bool[]>((bools) =>
  144. // {
  145. // for (int i = 0; i < 6; i++)
  146. // {
  147. // mORKS.CookNoodlesComplete[i] = bools[i];
  148. // }
  149. // }));
  150. // Thread.Sleep(500);
  151. // }), "ReadPLCData");
  152. // }
  153. // public ushort NoodleLoc { get; set; }
  154. // public ushort BowlLoc { get; set; }
  155. // public void SimOrder()
  156. // {
  157. // ActionManagerment.GetInstance.Register(new Action<object>((o) =>
  158. // {
  159. // if (o != null)
  160. // {
  161. // if (o is SimOrderData simOrderData)
  162. // {
  163. // string subId = Guid.NewGuid().ToString();
  164. // if (simOrderData.NoodleIsEnableRandom)
  165. // NoodleLoc = (ushort)(new Random().Next(1, 6));
  166. // else
  167. // NoodleLoc = (ushort)simOrderData.NoodleLoc;
  168. // if (simOrderData.BowlIsEnableRandom)
  169. // BowlLoc = (ushort)(new Random().Next(10, 12));
  170. // else
  171. // BowlLoc = (ushort)simOrderData.BowlLoc;
  172. // mORKS.RBTakeNoodleTask.Enqueue(new OrderLocInfo() { Loc = NoodleLoc, SuborderId = subId });
  173. // mORKS.TakeBowlTask.Enqueue(new OrderLocInfo() { Loc = BowlLoc, SuborderId = subId });
  174. // MessageLog.GetInstance.Show($"添加订单:面条位置【{NoodleLoc}】,碗位置【{BowlLoc}】");
  175. // }
  176. // }
  177. // }), "SimOrder");
  178. // }
  179. // /// <summary>
  180. // /// 数据解析
  181. // /// </summary>
  182. // public void DataParse<T>(T order)
  183. // {
  184. // if (order is MorkOrderPush morkOrderPush)
  185. // {
  186. // foreach (var item in morkOrderPush.GoodBatchings)
  187. // {
  188. // var res = Json<BatchingInfoPar>.Data.orderMaterialDelivery.BatchingInfo.FirstOrDefault(p => p.BatchingId == item.BatchingId);
  189. // if (res != null)
  190. // {
  191. // if (ushort.TryParse(res.BatchingLoc, out ushort loc))
  192. // {
  193. // if (loc >= 1 && loc <= 5)
  194. // {
  195. // mORKS.RBTakeNoodleTask.Enqueue(new OrderLocInfo() { Loc = loc, SuborderId = morkOrderPush.SuborderId, BatchingId = res.BatchingId });
  196. // }
  197. // else if (loc >= 10 && loc <= 11)
  198. // {
  199. // int index = Array.FindIndex(Json<BatchingInfoPar>.Data.recipeBoms.RecipeIds.ToArray(), p => p.RecipeId == morkOrderPush.RecipeId);
  200. // index++;
  201. // mORKS.TakeBowlTask.Enqueue(new OrderLocInfo() { Loc = loc, SuborderId = morkOrderPush.SuborderId, RecipeNumber = (index >= 1 && index <= 10) ? (ushort)index : (ushort)0 });
  202. // }
  203. // }
  204. // }
  205. // }
  206. // }
  207. // }
  208. // #region 临时变量
  209. // /// <summary>
  210. // /// 取碗订单ID
  211. // /// </summary>
  212. // string TakeBowlId = string.Empty;
  213. // /// <summary>
  214. // /// 配料完成订单ID
  215. // /// </summary>
  216. // string IngredientsCompleteId = string.Empty;
  217. // /// <summary>
  218. // /// 煮面口对应的订单ID
  219. // /// </summary>
  220. // string[] CookNodelId = new string[6] { string.Empty, string.Empty, string.Empty, string.Empty, string.Empty, string.Empty, };
  221. // /// <summary>
  222. // /// 出餐订单ID
  223. // /// </summary>
  224. // string OutMealId = string.Empty;
  225. // /// <summary>
  226. // /// 转台位置轮询
  227. // /// </summary>
  228. // List<ushort> TurntableLoc = new List<ushort>();
  229. // #endregion
  230. // public void Main()
  231. // {
  232. // ThreadManagerment.GetInstance.StartLong(new Action(() =>
  233. // {
  234. // mORKS.AllowRun = mORKS.InitComplete && !mORKS.TemperatureReached;
  235. // TakeBowlTask();
  236. // TakeNoodleTask();
  237. // OutNoodleTask();
  238. // SingleDetect();
  239. // TurntableControl();
  240. // Thread.Sleep(100);
  241. // }), "MainTask");
  242. // }
  243. // /// <summary>
  244. // /// 取碗控制
  245. // /// </summary>
  246. // private void TakeBowlTask()
  247. // {
  248. // if (mORKS.AllowRun && mORKS.TakeBowlTask.Count > 0 && !mORKS.TakeBowlIdle && !mORKS.TakeBowlInterlock)
  249. // {
  250. // if (mORKS.TakeBowlTask.TryDequeue(out OrderLocInfo orderLocInfo))
  251. // {
  252. // TakeBowlId = orderLocInfo.SuborderId;
  253. // TakeBowlControl(orderLocInfo.Loc);
  254. // SetRecipeNumber(orderLocInfo.RecipeNumber);
  255. // SimpleFactory.GetInstance.OrderChanged(TakeBowlId, ORDER_STATUS.COOKING);
  256. // MessageLog.GetInstance.Show($"订单【{TakeBowlId}】执行取碗控制,位置:[{orderLocInfo.Loc}]");
  257. // }
  258. // mORKS.TakeBowlInterlock = true;
  259. // }
  260. // }
  261. // /// <summary>
  262. // /// 转台控制
  263. // /// </summary>
  264. // private void TurntableControl()
  265. // {
  266. // if (mORKS.TurntableMoveInPlace && mORKS.InitComplete && !mORKS.AllowTakeNoodle && mORKS.RBTakeNoodleTask.Count > 0)
  267. // {
  268. // if (mORKS.TurntableLowerLimit)
  269. // {
  270. // SetTurntableLoc(mORKS.RBTakeNoodleTask.ElementAt(0).Loc);
  271. // MoveTurntable();
  272. // mORKS.AllowTakeNoodle = true;
  273. // TurntableLoc.Clear();
  274. // MessageLog.GetInstance.Show("转台位置OK");
  275. // }
  276. // else
  277. // {
  278. // if (!mORKS.TurntableInterlock)
  279. // {
  280. // var result = Json<BatchingInfoPar>.Data.orderMaterialDelivery.BatchingInfo.Where(p => p.BatchingId == mORKS.RBTakeNoodleTask.ElementAt(0).BatchingId).ToList();
  281. // if (result != null)
  282. // {
  283. // foreach (var item in result)
  284. // {
  285. // if (ushort.TryParse(item.BatchingLoc, out ushort loc))
  286. // {
  287. // if (TurntableLoc.Contains(loc))
  288. // {
  289. // SetTurntableLoc(loc);
  290. // MoveTurntable();
  291. // mORKS.TurntableInterlock = true;
  292. // TurntableLoc.Add(loc);
  293. // return;
  294. // }
  295. // }
  296. // }
  297. // MessageLog.GetInstance.Show("转台位置缺少物料");
  298. // }
  299. // }
  300. // }
  301. // }
  302. // }
  303. // /// <summary>
  304. // /// 取面任务
  305. // /// </summary>
  306. // private void TakeNoodleTask()
  307. // {
  308. // //取面控制
  309. // if (mORKS.AllowRun && mORKS.RobotIdle && !mORKS.RobotTaskInterlock && mORKS.AllowTakeNoodle && mORKS.TurntableMoveInPlace && !mORKS.TakeNoodleInterlock && !mORKS.OutNoodleing && mORKS.RBTakeNoodleTask.Count > 0)
  310. // {
  311. // int loc = Array.FindIndex(mORKS.NoodleCookerStatus, p => p == false);//查找煮面炉空闲位置
  312. // if (loc >= 0 && loc <= 5)
  313. // {
  314. // if (mORKS.RBTakeNoodleTask.TryDequeue(out OrderLocInfo orderLocInfo))
  315. // {
  316. // //设置转台位置
  317. // SetTurntableLoc(orderLocInfo.Loc);
  318. // //设置倒面位置
  319. // CookNodelId[loc] = orderLocInfo.SuborderId;
  320. // SetFallNoodleLoc((ushort)(loc + 1));
  321. // //机器人开始取面
  322. // RobotTakeNoodle();
  323. // SimpleFactory.GetInstance.OrderChanged(orderLocInfo.SuborderId, ORDER_STATUS.COOKING);
  324. // MessageLog.GetInstance.Show($"订单【{orderLocInfo.SuborderId}】,转台:[{orderLocInfo}],煮面栏:[{loc + 1}]");
  325. // mORKS.TakeNoodleInterlock = true;
  326. // }
  327. // }
  328. // }
  329. // }
  330. // /// <summary>
  331. // /// 出餐控制
  332. // /// </summary>
  333. // private void OutNoodleTask()
  334. // {
  335. // if (mORKS.AllowFallNoodle && mORKS.RobotTaskInterlock && !mORKS.TakeNoodleInterlock && mORKS.RobotIdle && !mORKS.TakeMealDetect)
  336. // {
  337. // int loc = Array.FindIndex(CookNodelId, p => p == IngredientsCompleteId && p.Length > 0);
  338. // if (loc >= 0 && loc <= 5)
  339. // {
  340. // if (mORKS.CookNoodlesComplete[loc])
  341. // {
  342. // SetTakeNoodleLoc((ushort)(loc + 1));
  343. // RobotOutMeal();
  344. // CookNoodleStatusReset((ushort)(loc + 1));
  345. // ResetAllowFallNoodle();
  346. // OutMealId = IngredientsCompleteId;
  347. // IngredientsCompleteId = string.Empty;
  348. // CookNodelId[loc] = string.Empty;
  349. // MessageLog.GetInstance.Show($"{loc + 1}号位置出餐控制");
  350. // mORKS.OutNoodleing = true;
  351. // }
  352. // }
  353. // }
  354. // }
  355. // /// <summary>
  356. // /// 信号检测
  357. // /// </summary>
  358. // private void SingleDetect()
  359. // {
  360. // //允许倒面信号检测
  361. // if (RTrig.GetInstance("AllowFallNoodle").Start(mORKS.AllowFallNoodle))
  362. // {
  363. // IngredientsCompleteId = TakeBowlId;
  364. // TakeBowlId = string.Empty;
  365. // MessageLog.GetInstance.Show($"允许到面,{IngredientsCompleteId}");
  366. // mORKS.TakeBowlInterlock = false;
  367. // }
  368. // //出餐完成信号检测
  369. // if (RTrig.GetInstance("CompleteChange").Start(mORKS.RbOutMealComplete))
  370. // {
  371. // SimpleFactory.GetInstance.OrderChanged(OutMealId, ORDER_STATUS.COMPLETED_COOK);
  372. // MessageLog.GetInstance.Show($"订单【{OutMealId}】制作完成");
  373. // mORKS.OutNoodleing = false;
  374. // }
  375. // //取餐完成逻辑处理
  376. // if (DelayRTrig.GetInstance("CompleteChange1").Start(mORKS.RbOutMealComplete && !mORKS.TakeMealDetect, 2))
  377. // {
  378. // SimpleFactory.GetInstance.OrderChanged(OutMealId, ORDER_STATUS.COMPLETED_TAKE);
  379. // MessageLog.GetInstance.Show($"订单【{OutMealId}】取餐完成");
  380. // var RemoveItem = Json<MorkOrderPushPar>.Data.morkOrderPushes.FirstOrDefault(p => p.OrderPush.SuborderId == OutMealId);
  381. // if (RemoveItem != null)
  382. // {
  383. // Json<MorkOrderPushPar>.Data.morkOrderPushes.Remove(RemoveItem);
  384. // }
  385. // ResetCookComplete();
  386. // OutMealId = string.Empty;
  387. // }
  388. // //机器人取面完成信号检测
  389. // if (RTrig.GetInstance("TakeNoodleComplete").Start(mORKS.RbTakeNoodleComplete))
  390. // {
  391. // mORKS.TakeNoodleInterlock = false;
  392. // mORKS.AllowTakeNoodle = false;
  393. // MessageLog.GetInstance.Show("取面完成");
  394. // TakeNoodleCompleteReset();
  395. // }
  396. // //转台到位检测
  397. // if (RTrig.GetInstance("TurntableInPlace").Start(mORKS.TurntableMoveInPlace))
  398. // {
  399. // mORKS.TurntableInterlock = false;
  400. // }
  401. // int OutMealRequstCount = mORKS.CookNoodlesComplete.Where(p => p == true).ToList().Count;
  402. // int mlCount = mORKS.NoodleCookerStatus.Where(p => p == true).ToList().Count;
  403. // mORKS.RobotTaskInterlock = OutMealRequstCount > 0 && mORKS.AllowFallNoodle && (mlCount >= 2 || mORKS.RBTakeNoodleTask.Count == 0);
  404. // }
  405. // #region PLC 控制函数
  406. // /// <summary>
  407. // /// 写入配方数据到 PLC
  408. // /// </summary>
  409. // private void WriteRecipeBoms()
  410. // {
  411. // List<ushort> recipeBoms = new List<ushort>();
  412. // foreach (var item in Json<BatchingInfoPar>.Data.recipeBoms.RecipeIds)
  413. // {
  414. // foreach (var rec in item.Recipes)
  415. // {
  416. // recipeBoms.Add((ushort)rec);
  417. // }
  418. // }
  419. // if (recipeBoms.Count > 0)
  420. // {
  421. // if (ModbusTcpHelper.GetInstance.Write(1100, WriteType.HoldingRegisters, recipeBoms.ToArray()))
  422. // {
  423. // MessageLog.GetInstance.Show("成功写入配方数据");
  424. // }
  425. // }
  426. // }
  427. // /// <summary>
  428. // /// 转台移动
  429. // /// </summary>
  430. // private void MoveTurntable()
  431. // {
  432. // ModbusTcpHelper.GetInstance.Write(325, WriteType.Coils, true);
  433. // }
  434. // /// <summary>
  435. // /// 取面完成复位
  436. // /// </summary>
  437. // private void TakeNoodleCompleteReset()
  438. // {
  439. // ModbusTcpHelper.GetInstance.Write(1124, WriteType.Coils, false);
  440. // }
  441. // /// <summary>
  442. // /// 指定煮面口状态复位
  443. // /// </summary>
  444. // /// <param name="num"></param>
  445. // private void CookNoodleStatusReset(int num)
  446. // {
  447. // if (num >= 1 && num <= 6)
  448. // {
  449. // ushort addRess = (ushort)(1136 + num - 1);
  450. // ModbusTcpHelper.GetInstance.Write(addRess, WriteType.Coils, false);
  451. // MessageLog.GetInstance.Show($"{num}号煮面口占用复位");
  452. // }
  453. // }
  454. // /// <summary>
  455. // /// 写配方编号
  456. // /// </summary>
  457. // /// <param name="num"></param>
  458. // private void SetRecipeNumber(ushort num)
  459. // {
  460. // ModbusTcpHelper.GetInstance.Write(100, WriteType.HoldingRegisters, num);
  461. // }
  462. // /// <summary>
  463. // /// 设置转台位置
  464. // /// </summary>
  465. // /// <param name="loc"></param>
  466. // private void SetTurntableLoc(ushort loc)
  467. // {
  468. // ModbusTcpHelper.GetInstance.Write(101, WriteType.HoldingRegisters, loc);
  469. // }
  470. // /// <summary>
  471. // /// 设置倒面位置
  472. // /// </summary>
  473. // /// <param name="loc"></param>
  474. // private void SetFallNoodleLoc(ushort loc)
  475. // {
  476. // ModbusTcpHelper.GetInstance.Write(102, WriteType.HoldingRegisters, loc);
  477. // }
  478. // /// <summary>
  479. // /// 设置取面位置
  480. // /// </summary>
  481. // /// <param name="loc"></param>
  482. // private void SetTakeNoodleLoc(ushort loc)
  483. // {
  484. // ModbusTcpHelper.GetInstance.Write(103, WriteType.HoldingRegisters, loc);
  485. // }
  486. // /// <summary>
  487. // /// 取碗控制
  488. // /// </summary>
  489. // /// <param name="loc"></param>
  490. // private void TakeBowlControl(ushort loc)
  491. // {
  492. // if (loc == 10)
  493. // {
  494. // ModbusTcpHelper.GetInstance.Write(321, WriteType.Coils, true);
  495. // }
  496. // else if (loc == 11)
  497. // {
  498. // ModbusTcpHelper.GetInstance.Write(322, WriteType.Coils, true);
  499. // }
  500. // }
  501. // /// <summary>
  502. // /// 机器人取面
  503. // /// </summary>
  504. // private void RobotTakeNoodle()
  505. // {
  506. // ModbusTcpHelper.GetInstance.Write(323, WriteType.Coils, true);
  507. // }
  508. // /// <summary>
  509. // /// 机器人取餐
  510. // /// </summary>
  511. // private void RobotOutMeal()
  512. // {
  513. // ModbusTcpHelper.GetInstance.Write(324, WriteType.Coils, true);
  514. // var result = ModbusTcpHelper.GetInstance.Read(324, ReadType.Coils);
  515. // if (result is bool res)
  516. // while (!res)
  517. // {
  518. // ModbusTcpHelper.GetInstance.Write(324, WriteType.Coils, true);
  519. // }
  520. // }
  521. // /// <summary>
  522. // /// 制作完成信号复位
  523. // /// </summary>
  524. // private void ResetCookComplete()
  525. // {
  526. // ModbusTcpHelper.GetInstance.Write(1126, WriteType.Coils, false);
  527. // }
  528. // /// <summary>
  529. // /// 复位允许取面信号
  530. // /// </summary>
  531. // private void ResetAllowFallNoodle()
  532. // {
  533. // ModbusTcpHelper.GetInstance.Write(1123, WriteType.Coils, false);
  534. // }
  535. // /// <summary>
  536. // /// 设备初始化
  537. // /// </summary>
  538. // public async void DeviceInit()
  539. // {
  540. // ModbusTcpHelper.GetInstance.Write(320, WriteType.Coils, true);
  541. // await Task.Delay(1000);
  542. // ModbusTcpHelper.GetInstance.Write(320, WriteType.Coils, false);
  543. // }
  544. // #endregion
  545. // }
  546. //}