ReservoirMetalHomeRoutine.cs 3.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106
  1. using Aitex.Core.RT.Fsm;
  2. using Aitex.Core.RT.Routine;
  3. using Aitex.Core.Util;
  4. using CyberX8_Core;
  5. using CyberX8_RT.Modules.Metal;
  6. using CyberX8_RT.Modules.Reservoir;
  7. using MECF.Framework.Common.Routine;
  8. using MECF.Framework.Common.ToolLayout;
  9. using System;
  10. using System.Collections.Generic;
  11. using System.Linq;
  12. using System.Text;
  13. using System.Threading.Tasks;
  14. namespace CyberX8_RT.Modules
  15. {
  16. public class ReservoirMetalHomeRoutine : RoutineBase, IRoutine
  17. {
  18. private enum ReservoirStep
  19. {
  20. ReservoirHome,
  21. ReservoirDelay,
  22. ReservoirHomeWait,
  23. MetalHome,
  24. End,
  25. }
  26. #region 内部变量
  27. private ReservoirEntity _reservoirEntity;
  28. #endregion
  29. /// <summary>
  30. /// 构造函数
  31. /// </summary>
  32. /// <param name="module"></param>
  33. public ReservoirMetalHomeRoutine(string module) : base(module)
  34. {
  35. }
  36. /// <summary>
  37. /// 中止
  38. /// </summary>
  39. public void Abort()
  40. {
  41. Runner.Stop("Manual abort");
  42. }
  43. /// <summary>
  44. /// 监控
  45. /// </summary>
  46. /// <returns></returns>
  47. public RState Monitor()
  48. {
  49. Runner.RunIf(ReservoirStep.ReservoirHome, _reservoirEntity.IsAuto, ReservoirHome, _delay_1ms)
  50. .DelayIf(ReservoirStep.ReservoirDelay,_reservoirEntity.IsAuto,_delay_1s)
  51. .WaitWithStopConditionIf(ReservoirStep.ReservoirHomeWait,_reservoirEntity.IsAuto,() => { return _reservoirEntity.IsIdle; }, () => { return _reservoirEntity.State!=ReservoirState.Initializing&&!_reservoirEntity.IsIdle; })
  52. .Run(ReservoirStep.MetalHome, MetalsHome, _delay_1ms)
  53. .End(ReservoirStep.End, NullFun, _delay_1ms);
  54. return Runner.Status;
  55. }
  56. /// <summary>
  57. /// Reservoir Home
  58. /// </summary>
  59. /// <returns></returns>
  60. private bool ReservoirHome()
  61. {
  62. int reservoirInvoke = _reservoirEntity.Invoke("HomeAll");
  63. return reservoirInvoke==(int)ReservoirMsg.Initialize;
  64. }
  65. /// <summary>
  66. /// Metal Home
  67. /// </summary>
  68. /// <returns></returns>
  69. private bool MetalsHome()
  70. {
  71. ReservoirItem reservoirItem = ReservoirItemManager.Instance.GetReservoirItem(Module.ToString());
  72. if (reservoirItem != null)
  73. {
  74. List<MetalItem> metalItems = reservoirItem.MetalCells;
  75. if (metalItems != null && metalItems.Count > 0)
  76. {
  77. foreach (MetalItem metalItem in metalItems)
  78. {
  79. if (metalItem.Installed)
  80. {
  81. MetalEntity moduleEntity = Singleton<RouteManager>.Instance.GetModule<MetalEntity>(metalItem.ModuleName);
  82. if (moduleEntity.IsAuto)
  83. {
  84. moduleEntity.Invoke("HomeAll");
  85. }
  86. }
  87. }
  88. }
  89. }
  90. return true;
  91. }
  92. /// <summary>
  93. /// 启动
  94. /// </summary>
  95. /// <param name="objs"></param>
  96. /// <returns></returns>
  97. public RState Start(params object[] objs)
  98. {
  99. _reservoirEntity = Singleton<RouteManager>.Instance.GetModule<ReservoirEntity>(Module);
  100. return Runner.Start(Module.ToString(), "Reservoir Metal Home");
  101. }
  102. }
  103. }