SrdCommonDevice.cs 37 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991
  1. using Aitex.Core.RT.DataCenter;
  2. using Aitex.Core.RT.Device;
  3. using Aitex.Core.RT.Event;
  4. using Aitex.Core.RT.Log;
  5. using Aitex.Core.RT.OperationCenter;
  6. using Aitex.Core.RT.Routine;
  7. using Aitex.Core.RT.SCCore;
  8. using Aitex.Core.Util;
  9. using MECF.Framework.Common.Beckhoff.ModuleIO;
  10. using MECF.Framework.Common.CommonData.SRD;
  11. using MECF.Framework.Common.Persistent.Prewet;
  12. using MECF.Framework.Common.Persistent.SRD;
  13. using MECF.Framework.Common.TwinCat;
  14. using PunkHPX8_Core;
  15. using System.Reflection;
  16. using PunkHPX8_RT.Modules;
  17. using PunkHPX8_RT.Modules.SRD;
  18. using PunkHPX8_RT.Devices.AXIS;
  19. using MECF.Framework.Common.Persistent.Rinse;
  20. using System.Security.Principal;
  21. using MECF.Framework.Common.IOCore;
  22. using Aitex.Core.Common;
  23. namespace PunkHPX8_RT.Devices.SRD
  24. {
  25. public class SrdCommonDevice : BaseDevice, IDevice
  26. {
  27. /// <summary>
  28. /// Srd操作枚举
  29. /// </summary>
  30. private enum SrdCommonOperation
  31. {
  32. None,
  33. DoorClose,
  34. DoorOpen,
  35. ChuckVacuumOn,
  36. ChuckVacuumOff,
  37. LiftUpOn,
  38. LiftUpOff,
  39. FlippersIn,
  40. FlippersOut,
  41. ChuckATMClick
  42. }
  43. #region 常量
  44. private const string FLUID_CONTAINMENT = "FluidContainment";
  45. private const string VACUUM_VALUE = "VacuumValue";
  46. private const string WAFER_PRESENCE = "WaferPresence";
  47. private const string WAFER_PRESENCE_STATUS = "WaferPresenceStatus";
  48. private const string WATER_PRESSURE = "WaterPressure";
  49. private const string DOOR_CLOSE="DoorClose";
  50. private const string DOOR_CLOSED = "DoorClosed";
  51. private const string DOOR_OPENED = "DoorOpened";
  52. private const string WATER_ABOVE="WaterAbove";
  53. private const string WATER_BELOW = "WaterBelow";
  54. private const string CHUCK_VACUUM="ChuckVacuum";
  55. private const string EXHAUST_ON="ExhaustOn";
  56. private const string COMMON_DATA = "CommonData";
  57. private const string PERSISTENT_VALUE= "PersistentValue";
  58. private const string CHUCK_ATM_ON = "ChuckATMOn";
  59. private const string CHUCK_VACUUM_OK = "ChuckVacuumOK";
  60. private const string WAFER_PRESENT = "WaferPresent";
  61. private const string LIFT_UP = "LiftUp";
  62. private const string LIFT_UP_STATUS = "LiftUpStatus";
  63. private const string FLIPPER1_OUT_100_STATUS = "Flipper1Out100Status";
  64. private const string FLIPPER2_OUT_100_STATUS = "Flipper2Out100Status";
  65. private const string FLIPPER3_OUT_100_STATUS = "Flipper3Out100Status";
  66. private const string FLIPPER1_OUT_150_STATUS = "Flipper1Out150Status";
  67. private const string FLIPPER2_OUT_150_STATUS = "Flipper2Out150Status";
  68. private const string FLIPPER3_OUT_150_STATUS = "Flipper3Out150Status";
  69. private const string FLIPPER1_OUT_200_STATUS = "Flipper1Out200Status";
  70. private const string FLIPPER2_OUT_200_STATUS = "Flipper2Out200Status";
  71. private const string FLIPPER3_OUT_200_STATUS = "Flipper3Out200Status";
  72. private const string FLIPPERS_IN_100 = "FlippersIn100";
  73. private const string FLIPPERS_IN_150 = "FlippersIn150";
  74. private const string FLIPPERS_IN_200 = "FlippersIn200";
  75. private const string WATER_FLOW = "WaterFlow";
  76. private const string WATER_ON = "WaterOn";
  77. private const string N2_ON= "N2On";
  78. #endregion
  79. #region 内部变量
  80. /// <summary>
  81. /// Common数据
  82. /// </summary>
  83. private SrdCommonData _commonData = new SrdCommonData();
  84. /// <summary>
  85. /// 状态
  86. /// </summary>
  87. private RState _status;
  88. /// <summary>
  89. /// 当前操作
  90. /// </summary>
  91. private SrdCommonOperation _currentOperation;
  92. /// <summary>
  93. /// Wafer Presence
  94. /// </summary>
  95. private string _waferPresence;
  96. /// <summary>
  97. /// Persistent Value对象
  98. /// </summary>
  99. private SRDPersistentValue _srdPersistentValue;
  100. /// <summary>
  101. /// IsWaferPresence
  102. /// </summary>
  103. private bool _isWaferPresence = true;
  104. /// <summary>
  105. /// Total Device
  106. /// </summary>
  107. private TotalSRDDevice _totalSRDDevice;
  108. #region Routine
  109. /// <summary>
  110. /// Close Routine
  111. /// </summary>
  112. private SrdCommonDoorCloseRoutine _doorCloseRoutine;
  113. /// <summary>
  114. /// Vacuum Routine
  115. /// </summary>
  116. private SrdCommonChuckVacuumRoutine _chuckVacuumRoutine;
  117. /// <summary>
  118. /// Lift Up routine
  119. /// </summary>
  120. private SrdCommonLiftUpRoutine _liftUpRoutine;
  121. /// <summary>
  122. /// Flippers Routine
  123. /// </summary>
  124. private SrdCommonFlipperRoutine _flipperRoutine;
  125. /// <summary>
  126. /// Chuck ATM Click Routine
  127. /// </summary>
  128. private SrdCommonChuckATMRoutine _chuckATMRoutine;
  129. #endregion
  130. #endregion
  131. #region 属性
  132. /// <summary>
  133. /// Common数据
  134. /// </summary>
  135. public SrdCommonData CommonData
  136. {
  137. get { return _commonData; }
  138. }
  139. /// <summary>
  140. /// 状态
  141. /// </summary>
  142. public RState Status { get { return _status; } }
  143. /// <summary>
  144. /// Wafer Presence
  145. /// </summary>
  146. public string WaferPresence
  147. {
  148. get { return _waferPresence; }
  149. }
  150. /// <summary>
  151. /// IsWaferPresence
  152. /// </summary>
  153. public bool IsWaferPresence
  154. {
  155. get { return _isWaferPresence; }
  156. }
  157. #endregion
  158. /// <summary>
  159. /// 构造函数
  160. /// </summary>
  161. /// <param name="moduleName"></param>
  162. /// <param name="name"></param>
  163. public SrdCommonDevice(string moduleName) : base(moduleName, "Common", "Common", "Common")
  164. {
  165. }
  166. /// <summary>
  167. /// 初始化
  168. /// </summary>
  169. /// <returns></returns>
  170. public bool Initialize()
  171. {
  172. InitializeRoutine();
  173. SubscribeData();
  174. SubscribeValueAction();
  175. InitializeOperation();
  176. return true;
  177. }
  178. /// <summary>
  179. /// 初始化Routine
  180. /// </summary>
  181. private void InitializeRoutine()
  182. {
  183. _doorCloseRoutine = new SrdCommonDoorCloseRoutine(Module);
  184. _chuckVacuumRoutine = new SrdCommonChuckVacuumRoutine(Module);
  185. _liftUpRoutine = new SrdCommonLiftUpRoutine(Module);
  186. _flipperRoutine = new SrdCommonFlipperRoutine(Module);
  187. _chuckATMRoutine = new SrdCommonChuckATMRoutine(Module);
  188. }
  189. /// <summary>
  190. /// 订阅数据
  191. /// </summary>
  192. private void SubscribeData()
  193. {
  194. _srdPersistentValue = SRDPersistentManager.Instance.GetModulePersistentValue(Module);
  195. if(_srdPersistentValue==null)
  196. {
  197. LOG.WriteLog(eEvent.ERR_SRD, Module, "Persistent Value Object is not exist");
  198. }
  199. DATA.Subscribe($"{Module}.{PERSISTENT_VALUE}", () => _srdPersistentValue, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  200. DATA.Subscribe($"{Module}.{COMMON_DATA}", () => _commonData, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  201. DATA.Subscribe($"{Module}.{WAFER_PRESENCE_STATUS}", () => _waferPresence, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  202. DATA.Subscribe($"{Module}.IsWaferPresence", () => IsWaferPresence, SubscriptionAttribute.FLAG.IgnoreSaveDB);
  203. }
  204. /// <summary>
  205. /// 订阅变量数值发生变化
  206. /// </summary>
  207. private void SubscribeValueAction()
  208. {
  209. IOModuleManager.Instance.SubscribeModuleVariable(Module, VACUUM_VALUE, UpdateVariableValue);
  210. IOModuleManager.Instance.SubscribeModuleVariable(Module, WAFER_PRESENCE, UpdateVariableValue);
  211. IOModuleManager.Instance.SubscribeModuleVariable(Module, DOOR_CLOSE, UpdateVariableValue);
  212. IOModuleManager.Instance.SubscribeModuleVariable(Module, DOOR_CLOSED, UpdateVariableValue);
  213. IOModuleManager.Instance.SubscribeModuleVariable(Module, DOOR_OPENED, UpdateVariableValue);
  214. IOModuleManager.Instance.SubscribeModuleVariable(Module, WATER_ABOVE, UpdateVariableValue);
  215. IOModuleManager.Instance.SubscribeModuleVariable(Module, WATER_BELOW, UpdateVariableValue);
  216. IOModuleManager.Instance.SubscribeModuleVariable(Module, CHUCK_VACUUM, UpdateVariableValue);
  217. IOModuleManager.Instance.SubscribeModuleVariable(Module, EXHAUST_ON, UpdateVariableValue);
  218. IOModuleManager.Instance.SubscribeModuleVariable(Module, CHUCK_ATM_ON, UpdateVariableValue);
  219. IOModuleManager.Instance.SubscribeModuleVariable(Module, CHUCK_VACUUM_OK, UpdateVariableValue);
  220. IOModuleManager.Instance.SubscribeModuleVariable(Module, WAFER_PRESENT, UpdateVariableValue);
  221. IOModuleManager.Instance.SubscribeModuleVariable(Module, LIFT_UP, UpdateVariableValue);
  222. IOModuleManager.Instance.SubscribeModuleVariable(Module, LIFT_UP_STATUS, UpdateVariableValue);
  223. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER1_OUT_100_STATUS, UpdateVariableValue);
  224. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER2_OUT_100_STATUS, UpdateVariableValue);
  225. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER3_OUT_100_STATUS, UpdateVariableValue);
  226. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER1_OUT_150_STATUS, UpdateVariableValue);
  227. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER2_OUT_150_STATUS, UpdateVariableValue);
  228. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER3_OUT_150_STATUS, UpdateVariableValue);
  229. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER1_OUT_200_STATUS, UpdateVariableValue);
  230. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER2_OUT_200_STATUS, UpdateVariableValue);
  231. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPER3_OUT_200_STATUS, UpdateVariableValue);
  232. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPERS_IN_100, UpdateVariableValue);
  233. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPERS_IN_150, UpdateVariableValue);
  234. IOModuleManager.Instance.SubscribeModuleVariable(Module, FLIPPERS_IN_200, UpdateVariableValue);
  235. IOModuleManager.Instance.SubscribeModuleVariable(Module, WATER_FLOW, UpdateVariableValue);
  236. IOModuleManager.Instance.SubscribeModuleVariable(Module, N2_ON, UpdateVariableValue);
  237. IOModuleManager.Instance.SubscribeModuleVariable(Module, WATER_ON, UpdateVariableValue);
  238. }
  239. /// <summary>
  240. /// 初始化操作
  241. /// </summary>
  242. private void InitializeOperation()
  243. {
  244. OP.Subscribe($"{Module}.{Name}.DoorClose", DoorCloseAction);
  245. OP.Subscribe($"{Module}.{Name}.DoorOpen", DoorOpenAction);
  246. OP.Subscribe($"{Module}.{Name}.WaterOn", WaterOnAction);
  247. OP.Subscribe($"{Module}.{Name}.WaterOff", WaterOffAction);
  248. OP.Subscribe($"{Module}.{Name}.ChuckVacuumOn", ChuckVacuumOnAction);
  249. OP.Subscribe($"{Module}.{Name}.ChuckVacuumOff", ChuckVacuumOffAction);
  250. OP.Subscribe($"{Module}.{Name}.N2On", N2OnAction);
  251. OP.Subscribe($"{Module}.{Name}.N2Off", N2OffAction);
  252. OP.Subscribe($"{Module}.{Name}.LiftUpOn", LiftUpOnAction);
  253. OP.Subscribe($"{Module}.{Name}.LiftUpOff", LiftUpOffAction);
  254. OP.Subscribe($"{Module}.{Name}.ChuckATMOn", ChuckATMOnAction);
  255. OP.Subscribe($"{Module}.{Name}.ChuckATMOff", ChuckATMOffAction);
  256. OP.Subscribe($"{Module}.{Name}.FlipperIn", FlipperInAction);
  257. OP.Subscribe($"{Module}.{Name}.FlipperOut", FlipperOutAction);
  258. OP.Subscribe($"{Module}.KeyDown", KeyDownAction);
  259. OP.Subscribe($"{Module}.DisabledAction", DisabledOperation);
  260. OP.Subscribe($"{Module}.ManualAction", ManualOperation);
  261. OP.Subscribe($"{Module}.AutoAction", AutoOperation);
  262. OP.Subscribe($"{Module}.EngineeringModeAction", EngineeringModeOperation);
  263. OP.Subscribe($"{Module}.ProductionModeAction", ProductionModeOperation);
  264. OP.Subscribe($"{Module}.UpdateIsWaferPresenceAction", UpdateIsWaferPresenceAction);
  265. }
  266. /// 更新变量数值
  267. /// </summary>
  268. /// <param name="variable"></param>
  269. /// <param name="value"></param>
  270. private void UpdateVariableValue(string variable, object value)
  271. {
  272. if(!CommonData.IsDataInitialized)
  273. {
  274. CommonData.IsDataInitialized = true;
  275. }
  276. PropertyInfo property = CommonData.GetType().GetProperty(variable);
  277. if (property != null)
  278. {
  279. property.SetValue(CommonData, value);
  280. }
  281. UpdateWaferPresence(variable, value);
  282. }
  283. /// <summary>
  284. /// 更新Wafer Presence
  285. /// </summary>
  286. private void UpdateWaferPresence(string variable,object value)
  287. {
  288. if (variable == WAFER_PRESENCE&&value is double)
  289. {
  290. UpdateWaferPresence((double)value);
  291. }
  292. }
  293. /// <summary>
  294. /// 更新Wafer Presence
  295. /// </summary>
  296. /// <param name="waferPresence"></param>
  297. private void UpdateWaferPresence(double waferPresence)
  298. {
  299. if (_srdPersistentValue != null)
  300. {
  301. if (waferPresence > _srdPersistentValue.EmptyThreshold)
  302. {
  303. _waferPresence = "Empty";
  304. }
  305. else if (waferPresence >= _srdPersistentValue.WellPlacedHighThreshold && waferPresence <= _srdPersistentValue.EmptyThreshold)
  306. {
  307. _waferPresence = "PoorlyPlaced";
  308. }
  309. else if (waferPresence < _srdPersistentValue.WellPlacedLowThreshold)
  310. {
  311. _waferPresence = "PoorlyPlaced";
  312. }
  313. else
  314. {
  315. _waferPresence = "WellPlaced";
  316. }
  317. }
  318. }
  319. #region Operation
  320. #region OperationStatus
  321. /// <summary>
  322. /// DisabledAction
  323. /// </summary>
  324. /// <param name="cmd"></param>
  325. /// <param name="param"></param>
  326. /// <returns></returns>
  327. private bool DisabledOperation(string cmd, object[] args)
  328. {
  329. string currentOperation = "Disabled";
  330. SRDEntity srdEntity = Singleton<RouteManager>.Instance.GetModule<SRDEntity>(Module);
  331. if (srdEntity != null && _srdPersistentValue != null && _srdPersistentValue.OperatingMode != currentOperation)
  332. {
  333. string preOperation = _srdPersistentValue.OperatingMode;
  334. if (srdEntity.IsBusy)
  335. {
  336. LOG.WriteLog(eEvent.ERR_SRD, Module, $"{Module} is Busy, can't change to Disabled mode");
  337. return false;
  338. }
  339. srdEntity.EnterInit();
  340. SRDPersistentManager.Instance.UpdateOperationModeValue(Module, currentOperation);
  341. LOG.WriteLog(eEvent.INFO_SRD, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  342. }
  343. return true;
  344. }
  345. /// <summary>
  346. /// ManualAction
  347. /// </summary>
  348. /// <param name="cmd"></param>
  349. /// <param name="param"></param>
  350. /// <returns></returns>
  351. private bool ManualOperation(string cmd, object[] args)
  352. {
  353. string currentOperation = "Manual";
  354. SRDEntity srdEntity = Singleton<RouteManager>.Instance.GetModule<SRDEntity>(Module);
  355. if (srdEntity != null && _srdPersistentValue != null && _srdPersistentValue.OperatingMode != currentOperation)
  356. {
  357. string preOperation = _srdPersistentValue.OperatingMode;
  358. if (srdEntity.IsBusy)
  359. {
  360. LOG.WriteLog(eEvent.ERR_SRD, Module, $"{Module} is Busy, can't change to Manual mode");
  361. return false;
  362. }
  363. srdEntity.EnterInit();
  364. SRDPersistentManager.Instance.UpdateOperationModeValue(Module, currentOperation);
  365. LOG.WriteLog(eEvent.INFO_SRD, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  366. }
  367. return true;
  368. }
  369. /// <summary>
  370. /// AutoAction
  371. /// </summary>
  372. /// <param name="cmd"></param>
  373. /// <param name="param"></param>
  374. /// <returns></returns>
  375. private bool AutoOperation(string cmd, object[] args)
  376. {
  377. string currentOperation = "Auto";
  378. SRDEntity srdEntity = Singleton<RouteManager>.Instance.GetModule<SRDEntity>(Module);
  379. if (srdEntity != null && _srdPersistentValue != null && _srdPersistentValue.OperatingMode != currentOperation)
  380. {
  381. string preOperation = _srdPersistentValue.OperatingMode;
  382. if (srdEntity.IsBusy)
  383. {
  384. LOG.WriteLog(eEvent.ERR_SRD, Module, $"{Module} is Busy, can't switch to Auto mode");
  385. return false;
  386. }
  387. srdEntity.EnterInit();
  388. SRDPersistentManager.Instance.UpdateOperationModeValue(Module, currentOperation);
  389. LOG.WriteLog(eEvent.INFO_SRD, Module, $"Operating mode is switched from {preOperation} to {currentOperation}");
  390. }
  391. return true;
  392. }
  393. /// <summary>
  394. /// EngineeringModeAction
  395. /// </summary>
  396. /// <param name="cmd"></param>
  397. /// <param name="param"></param>
  398. /// <returns></returns>
  399. private bool EngineeringModeOperation(string cmd, object[] args)
  400. {
  401. string currentRecipeOperation = "Engineering";
  402. SRDPersistentManager.Instance.UpdateRecipeOperationModeValue(Module, currentRecipeOperation);
  403. return true;
  404. }
  405. /// <summary>
  406. /// ProductionAction
  407. /// </summary>
  408. /// <param name="cmd"></param>
  409. /// <param name="param"></param>
  410. /// <returns></returns>
  411. private bool ProductionModeOperation(string cmd, object[] args)
  412. {
  413. string currentRecipeOperation = "Production";
  414. SRDPersistentManager.Instance.UpdateRecipeOperationModeValue(Module, currentRecipeOperation);
  415. return true;
  416. }
  417. #endregion
  418. #region keydown
  419. private bool KeyDownAction(string cmd, object[] args)
  420. {
  421. string variableName = args[0].ToString();
  422. PropertyInfo property = _srdPersistentValue.GetType().GetProperty(variableName);
  423. if(property!=null)
  424. {
  425. property.SetValue(_srdPersistentValue, args[1]);
  426. }
  427. SRDPersistentManager.Instance.UpdateModulePersistentValue(Module);
  428. UpdateWaferPresence(CommonData.WaferPresence);
  429. return true;
  430. }
  431. #endregion
  432. #region Door
  433. /// <summary>
  434. /// Door Close操作
  435. /// </summary>
  436. public bool DoorCloseAction(string cmd, object[] args)
  437. {
  438. if (!JudgeRunningState(SrdCommonOperation.DoorClose))
  439. {
  440. _currentOperation = SrdCommonOperation.DoorClose;
  441. _status = _doorCloseRoutine.Start(true);
  442. return _status==RState.Running;
  443. }
  444. else
  445. {
  446. return false;
  447. }
  448. }
  449. /// <summary>
  450. /// Door Open操作
  451. /// </summary>
  452. public bool DoorOpenAction(string cmd, object[] args)
  453. {
  454. if (!JudgeRunningState(SrdCommonOperation.DoorOpen))
  455. {
  456. _currentOperation = SrdCommonOperation.DoorOpen;
  457. _status = _doorCloseRoutine.Start(false);
  458. return _status==RState.Running;
  459. }
  460. else
  461. {
  462. return false;
  463. }
  464. }
  465. #endregion
  466. #region N2 On
  467. /// <summary>
  468. /// N2 On
  469. /// </summary>
  470. /// <param name="cmd"></param>
  471. /// <param name="args"></param>
  472. /// <returns></returns>
  473. public bool N2OnAction(string cmd, object[] args)
  474. {
  475. return N2On();
  476. }
  477. /// <summary>
  478. /// N2 Off
  479. /// </summary>
  480. /// <param name="cmd"></param>
  481. /// <param name="args"></param>
  482. /// <returns></returns>
  483. public bool N2OffAction(string cmd, object[] args)
  484. {
  485. return N2Off();
  486. }
  487. /// <summary>
  488. /// Exhaust On(不确认信号)
  489. /// </summary>
  490. /// <returns></returns>
  491. public bool N2On()
  492. {
  493. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{N2_ON}");
  494. return IOModuleManager.Instance.WriteIoValue(ioName, true);
  495. }
  496. /// <summary>
  497. /// Exhaust On(不确认信号)
  498. /// </summary>
  499. /// <returns></returns>
  500. public bool N2Off()
  501. {
  502. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{N2_ON}");
  503. return IOModuleManager.Instance.WriteIoValue(ioName, false);
  504. }
  505. #endregion
  506. #region Flipper
  507. /// <summary>
  508. /// FlipperIn
  509. /// </summary>
  510. /// <param name="cmd"></param>
  511. /// <param name="args"></param>
  512. /// <returns></returns>
  513. public bool FlipperInAction(string cmd, object[] args)
  514. {
  515. int waferSize = (int)args[0];
  516. if (!JudgeRunningState(SrdCommonOperation.FlippersIn))
  517. {
  518. _currentOperation = SrdCommonOperation.FlippersIn;
  519. _status = _flipperRoutine.Start(true, waferSize);
  520. return _status == RState.Running;
  521. }
  522. else
  523. {
  524. return false;
  525. }
  526. }
  527. /// <summary>
  528. /// FlipperOut
  529. /// </summary>
  530. /// <param name="cmd"></param>
  531. /// <param name="args"></param>
  532. /// <returns></returns>
  533. public bool FlipperOutAction(string cmd, object[] args)
  534. {
  535. int waferSize = (int)args[0];
  536. if (!JudgeRunningState(SrdCommonOperation.FlippersOut))
  537. {
  538. _currentOperation = SrdCommonOperation.FlippersOut;
  539. _status = _flipperRoutine.Start(false, waferSize);
  540. return _status == RState.Running;
  541. }
  542. else
  543. {
  544. return false;
  545. }
  546. }
  547. #endregion
  548. #region Water
  549. /// <summary>
  550. /// Water On操作
  551. /// </summary>
  552. public bool WaterOnAction(string cmd, object[] args)
  553. {
  554. return WaterOn();
  555. }
  556. /// <summary>
  557. /// water Off操作
  558. /// </summary>
  559. public bool WaterOffAction(string cmd, object[] args)
  560. {
  561. return WaterOff();
  562. }
  563. /// <summary>
  564. /// Water On(不确认信号)
  565. /// </summary>
  566. /// <returns></returns>
  567. public bool WaterOn()
  568. {
  569. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{WATER_ON}");
  570. return IOModuleManager.Instance.WriteIoValue(ioName, true);
  571. }
  572. /// <summary>
  573. /// Water Off(不确认信号)
  574. /// </summary>
  575. /// <returns></returns>
  576. public bool WaterOff()
  577. {
  578. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{WATER_ON}");
  579. return IOModuleManager.Instance.WriteIoValue(ioName, false);
  580. }
  581. #endregion
  582. #region Chuck Vacuum
  583. /// <summary>
  584. /// Chuck Vacuum操作
  585. /// </summary>
  586. public bool ChuckVacuumOnAction(string cmd, object[] args)
  587. {
  588. if (!JudgeRunningState(SrdCommonOperation.ChuckVacuumOn))
  589. {
  590. _currentOperation = SrdCommonOperation.ChuckVacuumOn;
  591. _status = _chuckVacuumRoutine.Start(false);
  592. return _status==RState.Running;
  593. }
  594. else
  595. {
  596. return false;
  597. }
  598. }
  599. /// <summary>
  600. /// chuck Vacuum Off操作
  601. /// </summary>
  602. public bool ChuckVacuumOffAction(string cmd, object[] args)
  603. {
  604. if (!JudgeRunningState(SrdCommonOperation.ChuckVacuumOff))
  605. {
  606. _currentOperation = SrdCommonOperation.ChuckVacuumOff;
  607. _status= _chuckVacuumRoutine.Start(true);
  608. return _status==RState.Running;
  609. }
  610. else
  611. {
  612. return false;
  613. }
  614. }
  615. #endregion
  616. #region LiftUp
  617. /// <summary>
  618. /// Lift Up On
  619. /// </summary>
  620. /// <param name="cmd"></param>
  621. /// <param name="args"></param>
  622. /// <returns></returns>
  623. public bool LiftUpOnAction(string cmd, object[] args)
  624. {
  625. if (!JudgeRunningState(SrdCommonOperation.LiftUpOn))
  626. {
  627. _currentOperation = SrdCommonOperation.LiftUpOn;
  628. _status = _liftUpRoutine.Start(true);
  629. return _status == RState.Running;
  630. }
  631. else
  632. {
  633. return false;
  634. }
  635. }
  636. /// <summary>
  637. /// Lift Up Off
  638. /// </summary>
  639. /// <param name="cmd"></param>
  640. /// <param name="args"></param>
  641. /// <returns></returns>
  642. public bool LiftUpOffAction(string cmd, object[] args)
  643. {
  644. if (!JudgeRunningState(SrdCommonOperation.LiftUpOff))
  645. {
  646. _currentOperation = SrdCommonOperation.LiftUpOff;
  647. _status = _liftUpRoutine.Start(false);
  648. return _status == RState.Running;
  649. }
  650. else
  651. {
  652. return false;
  653. }
  654. }
  655. #endregion
  656. #region ChuckATM
  657. /// <summary>
  658. /// Chuck ATM On
  659. /// </summary>
  660. /// <param name="cmd"></param>
  661. /// <param name="args"></param>
  662. /// <returns></returns>
  663. public bool ChuckATMOnAction(string cmd, object[] args)
  664. {
  665. if(CommonData.LiftUp || CommonData.LiftUpStatus)
  666. {
  667. LOG.WriteLog(eEvent.ERR_SRD, Module, "LiftUp is on, can't chuckATM");
  668. return false;
  669. }
  670. return ChuckATM(true);
  671. }
  672. /// <summary>
  673. /// Chuck ATM Off
  674. /// </summary>
  675. /// <param name="cmd"></param>
  676. /// <param name="args"></param>
  677. /// <returns></returns>
  678. public bool ChuckATMOffAction(string cmd, object[] args)
  679. {
  680. return ChuckATM(false);
  681. }
  682. private bool ChuckATM(bool value)
  683. {
  684. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{CHUCK_ATM_ON}");
  685. return IOModuleManager.Instance.WriteIoValue(ioName, value);
  686. }
  687. /// <summary>
  688. /// Chuck ATM Routine
  689. /// </summary>
  690. /// <param name="cmd"></param>
  691. /// <param name="args"></param>
  692. /// <returns></returns>
  693. public bool ChuckATMAction(string cmd, object[] args)
  694. {
  695. if (!JudgeRunningState(SrdCommonOperation.ChuckATMClick))
  696. {
  697. _currentOperation = SrdCommonOperation.ChuckATMClick;
  698. _status = _chuckATMRoutine.Start();
  699. return _status == RState.Running;
  700. }
  701. else
  702. {
  703. return false;
  704. }
  705. }
  706. #endregion
  707. #region Water Above
  708. /// <summary>
  709. /// Water Above On操作
  710. /// </summary>
  711. public bool WaterAboveOnAction(string cmd, object[] args)
  712. {
  713. return WaterAboveOn();
  714. }
  715. /// <summary>
  716. /// water above Off操作
  717. /// </summary>
  718. public bool WaterAboveOffAction(string cmd, object[] args)
  719. {
  720. return WaterAboveOff();
  721. }
  722. /// <summary>
  723. /// Water Above On(不确认信号)
  724. /// </summary>
  725. /// <returns></returns>
  726. public bool WaterAboveOn()
  727. {
  728. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{WATER_ABOVE}");
  729. return IOModuleManager.Instance.WriteIoValue(ioName, true);
  730. }
  731. /// <summary>
  732. /// Water Above Off(不确认信号)
  733. /// </summary>
  734. /// <returns></returns>
  735. public bool WaterAboveOff()
  736. {
  737. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{WATER_ABOVE}");
  738. return IOModuleManager.Instance.WriteIoValue(ioName, false);
  739. }
  740. #endregion
  741. #region Water Below
  742. /// <summary>
  743. /// Water Below On操作
  744. /// </summary>
  745. public bool WaterBelowOnAction(string cmd, object[] args)
  746. {
  747. return WaterBelowOn();
  748. }
  749. /// <summary>
  750. /// water Below Off操作
  751. /// </summary>
  752. public bool WaterBelowOffAction(string cmd, object[] args)
  753. {
  754. return WaterBelowOff();
  755. }
  756. /// <summary>
  757. /// Water Below On(不确认信号)
  758. /// </summary>
  759. /// <returns></returns>
  760. public bool WaterBelowOn()
  761. {
  762. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{WATER_BELOW}");
  763. return IOModuleManager.Instance.WriteIoValue(ioName, true);
  764. }
  765. /// <summary>
  766. /// Water Below Off(不确认信号)
  767. /// </summary>
  768. /// <returns></returns>
  769. public bool WaterBelowOff()
  770. {
  771. string ioName = BeckhoffModuleIOManager.Instance.GetIoNameByInnerModuleName($"{Module}.{WATER_BELOW}");
  772. return IOModuleManager.Instance.WriteIoValue(ioName, false);
  773. }
  774. #endregion
  775. /// <summary>
  776. /// Update IsWaferPresence 标志位
  777. /// </summary>
  778. /// <param name="cmd"></param>
  779. /// <param name="args"></param>
  780. /// <returns></returns>
  781. public bool UpdateIsWaferPresenceAction(string cmd, object[] args)
  782. {
  783. _isWaferPresence = (bool)args[0];
  784. return true;
  785. }
  786. /// <summary>
  787. /// 判定运行状态
  788. /// </summary>
  789. /// <returns></returns>
  790. private bool JudgeRunningState(SrdCommonOperation operation)
  791. {
  792. if (_status == RState.Running)
  793. {
  794. EV.PostAlarmLog($"{Module}", eEvent.ERR_SRD, $"{Module} current execute {_currentOperation},cannot {operation}");
  795. return true;
  796. }
  797. return false;
  798. }
  799. /// <summary>
  800. /// ErrorOperation
  801. /// </summary>
  802. public void EnterErrorOperation()
  803. {
  804. //关闭风扇
  805. if (CommonData.N2On)
  806. {
  807. bool result = N2OffAction("", null);
  808. if (!result)
  809. {
  810. LOG.WriteLog(eEvent.ERR_SRD, Module, "EnterError: N2 Off is failed");
  811. }
  812. }
  813. //关闭WaterAbove
  814. if (CommonData.WaterOn)
  815. {
  816. bool result = WaterOff();
  817. if (!result)
  818. {
  819. LOG.WriteLog(eEvent.INFO_SRD, Module, "EnterError: Water Off is failed");
  820. }
  821. }
  822. }
  823. #endregion
  824. /// <summary>
  825. /// Rotation InterLock
  826. /// </summary>
  827. /// <returns></returns>
  828. public bool RotationInterLock()
  829. {
  830. if (!CommonData.DoorClosed)
  831. {
  832. LOG.WriteLog(eEvent.ERR_SRD, Module, "Door is not closed. Rotation can not position");
  833. return false;
  834. }
  835. //Check Flippers
  836. if (CommonData.FlippersIn150 || CommonData.FlippersIn200) //|| _srdCommon.CommonData.FlippersIn100
  837. {
  838. LOG.WriteLog(eEvent.ERR_SRD, Module, "FlippersIn is on. Rotation can not position");
  839. return false;
  840. }
  841. if (!CommonData.Flipper1Out150Status || !CommonData.Flipper2Out150Status || !CommonData.Flipper3Out150Status
  842. || !CommonData.Flipper1Out200Status || !CommonData.Flipper2Out200Status || !CommonData.Flipper3Out200Status)
  843. //|| !_srdCommon.CommonData.Flipper1Out100Status || !_srdCommon.CommonData.Flipper2Out100Status || !_srdCommon.CommonData.Flipper3Out100Status
  844. {
  845. LOG.WriteLog(eEvent.ERR_SRD, Module, "Flippers are at In position. Rotation can not position");
  846. return false;
  847. }
  848. return true;
  849. }
  850. /// <summary>
  851. /// 定时器
  852. /// </summary>
  853. /// <returns></returns>
  854. public bool OnTimer()
  855. {
  856. if (_status == RState.Running)
  857. {
  858. if (_currentOperation != SrdCommonOperation.None)
  859. {
  860. IRoutine routine = GetCurrentRoutine(_currentOperation);
  861. if (routine != null)
  862. {
  863. CheckRoutineState(routine, _currentOperation);
  864. }
  865. else
  866. {
  867. EndOperation();
  868. }
  869. }
  870. }
  871. //将公有的数据赋值于对象的数值
  872. if (_totalSRDDevice == null)
  873. {
  874. _totalSRDDevice = DEVICE.GetDevice<TotalSRDDevice>("SRD");
  875. }
  876. if (_totalSRDDevice != null)
  877. {
  878. CommonData.FluidContainment = _totalSRDDevice.FluidContainment;
  879. CommonData.WaterPressure = _totalSRDDevice.WaterPressure;
  880. }
  881. return true;
  882. }
  883. /// <summary>
  884. /// 获取当前操作对应的Routine
  885. /// </summary>
  886. /// <param name="currentOperation"></param>
  887. /// <returns></returns>
  888. private IRoutine GetCurrentRoutine(SrdCommonOperation currentOperation)
  889. {
  890. switch (currentOperation)
  891. {
  892. case SrdCommonOperation.DoorClose:
  893. case SrdCommonOperation.DoorOpen:
  894. return _doorCloseRoutine;
  895. case SrdCommonOperation.ChuckVacuumOn:
  896. case SrdCommonOperation.ChuckVacuumOff:
  897. return _chuckVacuumRoutine;
  898. case SrdCommonOperation.LiftUpOn:
  899. case SrdCommonOperation.LiftUpOff:
  900. return _liftUpRoutine;
  901. case SrdCommonOperation.FlippersIn:
  902. case SrdCommonOperation.FlippersOut:
  903. return _flipperRoutine;
  904. case SrdCommonOperation.ChuckATMClick:
  905. return _chuckATMRoutine;
  906. default:
  907. return null;
  908. }
  909. }
  910. /// <summary>
  911. /// 检验Routine状态
  912. /// </summary>
  913. /// <param name="routine"></param>
  914. /// <param name="currentOperation"></param>
  915. private void CheckRoutineState(IRoutine routine, SrdCommonOperation currentOperation)
  916. {
  917. RState state = routine.Monitor();
  918. if (state == RState.End)
  919. {
  920. EndOperation();
  921. }
  922. else if (state == RState.Failed || state == RState.Timeout)
  923. {
  924. LOG.WriteLog(eEvent.ERR_SRD, $"{Module}", $"{currentOperation} error");
  925. _status= RState.Failed;
  926. _currentOperation= SrdCommonOperation.None;
  927. }
  928. }
  929. /// <summary>
  930. /// 结束操作
  931. /// </summary>
  932. private void EndOperation()
  933. {
  934. _status = RState.End;
  935. _currentOperation = SrdCommonOperation.None;
  936. }
  937. #region 设备接口
  938. /// <summary>
  939. /// 监控
  940. /// </summary>
  941. public void Monitor()
  942. {
  943. }
  944. public void Reset()
  945. {
  946. }
  947. public void Terminate()
  948. {
  949. }
  950. #endregion
  951. }
  952. }