LoaderLoadRoutine.cs 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677
  1. using Aitex.Core.RT.Device;
  2. using Aitex.Core.RT.Log;
  3. using Aitex.Core.RT.Routine;
  4. using Aitex.Core.RT.SCCore;
  5. using Aitex.Core.Util;
  6. using MECF.Framework.Common.Equipment;
  7. using MECF.Framework.Common.Routine;
  8. using MECF.Framework.Common.Utilities;
  9. using CyberX8_Core;
  10. using CyberX8_RT.Devices.AXIS;
  11. using CyberX8_RT.Devices.AXIS.CANOpen;
  12. using CyberX8_RT.Modules.PUF;
  13. using CyberX8_RT.Modules;
  14. using System;
  15. using System.Collections.Generic;
  16. using System.Linq;
  17. using System.Text;
  18. using System.Threading.Tasks;
  19. using MECF.Framework.Common.CommonData.Loader;
  20. using CyberX8_RT.Modules.Transporter;
  21. using MECF.Framework.Common.WaferHolder;
  22. namespace CyberX8_RT.Devices.Loader
  23. {
  24. public class LoaderLoadRoutine : RoutineBase, IRoutine
  25. {
  26. private enum LoadStep
  27. {
  28. CheckPreCondition,
  29. WSClampOn,
  30. WSSideClampOn,
  31. WSSideClampOnCheck,
  32. BernoulliBladderOn,
  33. BernoulliBladderOnCheck,
  34. TranslateBladderOff,
  35. TranslateBladderOffCheck,
  36. CRSGotoUnlock,
  37. CRSGotoUnlockWait,
  38. BernoulliN2On,
  39. BernoulliN2OnCheck,
  40. BernoulliBladderOff,
  41. BernoulliBladderOffCheck,
  42. TiltGotoFloat,
  43. TiltGotoFloatWait,
  44. ReBernoulliBladderOn,
  45. ReBernoulliBladderOnCheck,
  46. TiltGotoVertical,
  47. TiltGotoVerticalWait,
  48. CRSVacuumValue,
  49. CRSVacuumValueCheck,
  50. ShuttleGotoClose,
  51. ShuttleGotoCloseWait,
  52. ReCRSVacuumValue,
  53. ReCRSVacuumValueCheck,
  54. DoorLockOn,
  55. DoorLockOnCheck,
  56. WSBladderOn,
  57. WSBladderOnCheck,
  58. TransBladderOn,
  59. TransBladderOnCheck,
  60. TransHighOff,
  61. TransHighOffCheck,
  62. CRSGotoSetUp,
  63. CRSGotoSetUpWait,
  64. CRSGotoLock,
  65. CRSGotoLockWait,
  66. BernoulliN2Off,
  67. BernoulliN2OffCheck,
  68. WSBladderOff,
  69. WSBladderOffCheck,
  70. CRSReleaseDelay,
  71. CRSVacuumOff,
  72. CRSVacuumOffCheck,
  73. TranslateBladderReleaseDelay,
  74. ReTranslateBladderOff,
  75. ReTranslateBladderOffCheck,
  76. TranslateHighPresOff,
  77. TranslateHighPresOffCheck,
  78. HomingCRSAxis,
  79. HomingCRSAxisWait,
  80. CRSHomedGotoSetUp,
  81. CRSHomedGotoSetUpCheck,
  82. End
  83. }
  84. #region 内部变量
  85. private string _side = "";
  86. private int _crsVacuumReleaseDelayInMilliseconds = 250;
  87. private int _translateOutDelayInMilliseconds = 250;
  88. private JetAxisBase _crsAxis;
  89. private JetAxisBase _tiltAxis;
  90. private JetAxisBase _shuttleAxis;
  91. private JetAxisBase _rotationAxis;
  92. private LoaderCommonDevice _loaderCommonDevice;
  93. private LoaderSideDevice _sideDevice;
  94. private LoaderCommonWaferHolderSideClampRoutine _waferHolderSideClampRoutine;
  95. private LoaderSideBernoulliBladderRoutine _bernoulliBladderRoutine;
  96. private LoaderSideTransBladderRoutine _transBladderRoutine;
  97. private LoaderSideBernoulliN2PressureRoutine _bernoulliN2PressureRoutine;
  98. private LoaderSideVacuumAndLevelCheckRoutineRoutine _vacuumAndLevelCheckRoutineRoutine;
  99. private LoaderSideVacuumLevelCheckRoutine _vacuumLevelCheckRoutine;
  100. private LoaderSideDoorLockRoutine _doorLockRoutine;
  101. private LoaderSideWhBladderRoutine _whBladderRoutine;
  102. private LoaderSideTransHighRoutine _transHighPressureRoutine;
  103. #endregion
  104. /// <summary>
  105. /// 构造函数
  106. /// </summary>
  107. /// <param name="module"></param>
  108. public LoaderLoadRoutine(string module,string side) : base(module)
  109. {
  110. _side = side;
  111. }
  112. /// <summary>
  113. /// 中止
  114. /// </summary>
  115. public void Abort()
  116. {
  117. Runner.Stop("Manual Abort");
  118. }
  119. /// <summary>
  120. /// 监控
  121. /// </summary>
  122. /// <returns></returns>
  123. public RState Monitor()
  124. {
  125. Runner.Run(LoadStep.CheckPreCondition,CheckPreCondition,_delay_1ms)
  126. //1.0 WS Clamp On
  127. .Run(LoadStep.WSClampOn, WaferHolderClampOn,_delay_1ms)
  128. //1.1 WSSideClampOn
  129. .Run(LoadStep.WSSideClampOn, () => { return _waferHolderSideClampRoutine.Start(true) == RState.Running; },_delay_1ms)
  130. .WaitWithStopCondition(LoadStep.WSSideClampOnCheck, () => { return CommonFunction.CheckRoutineEndState(_waferHolderSideClampRoutine); },
  131. () => CheckRoutineStopStatus(_waferHolderSideClampRoutine,"WaferHolder Side Clamp on failed"))
  132. //1.2 BernoulliBladderOn
  133. .Run(LoadStep.BernoulliBladderOn, () => { return _bernoulliBladderRoutine.Start(true) == RState.Running; },_delay_1ms)
  134. .WaitWithStopCondition(LoadStep.BernoulliBladderOnCheck, () => { return CommonFunction.CheckRoutineEndState(_bernoulliBladderRoutine); },
  135. () => CheckRoutineStopStatus(_bernoulliBladderRoutine, "BernoulliBladder On failed"))
  136. //1.3 TranslateBladderOff
  137. .Run(LoadStep.TranslateBladderOff, () => { return _transBladderRoutine.Start(false) == RState.Running; },_delay_1ms)
  138. .WaitWithStopCondition(LoadStep.TranslateBladderOffCheck, () => { return CommonFunction.CheckRoutineEndState(_transBladderRoutine); },
  139. () => CheckRoutineStopStatus(_transBladderRoutine,"TransBladder Off failed"))
  140. //1.4 CRS Goto Unlock
  141. .Run(LoadStep.CRSGotoUnlock, () => { return AxisPosition(_crsAxis,"Unlock"); }, NullFun, _delay_1ms)
  142. .WaitWithStopCondition(LoadStep.CRSGotoUnlockWait, () => { return _crsAxis.Status == RState.End; },
  143. ()=>CheckAxisMotionStopStatus(_crsAxis))
  144. //1.5 BernoulliN2 On
  145. .Run(LoadStep.BernoulliN2On, () => { return _bernoulliN2PressureRoutine.Start(true)==RState.Running; },_delay_1ms)
  146. .WaitWithStopCondition(LoadStep.BernoulliN2OnCheck, () => { return CommonFunction.CheckRoutineEndState(_bernoulliN2PressureRoutine); },
  147. () => CheckRoutineStopStatus(_bernoulliN2PressureRoutine, "BernoulliN2 On failed"))
  148. //1.6 Bernoulli Bladder Off
  149. .Run(LoadStep.BernoulliBladderOff, () => { return _bernoulliBladderRoutine.Start(false) == RState.Running; }, _delay_1ms)
  150. .WaitWithStopCondition(LoadStep.BernoulliBladderOffCheck, () => { return CommonFunction.CheckRoutineEndState(_bernoulliBladderRoutine); },
  151. () => CheckRoutineStopStatus(_bernoulliBladderRoutine, "BernoulliBladder Off failed"))
  152. //1.7 Tilt Goto Float
  153. .Run(LoadStep.TiltGotoFloat, () => { return AxisPosition(_tiltAxis,"FLOAT"); }, NullFun, _delay_1ms)
  154. .WaitWithStopCondition(LoadStep.TiltGotoFloatWait, () => { return _tiltAxis.Status == RState.End; },
  155. () => CheckAxisMotionStopStatus(_tiltAxis))
  156. //1.8 Re Bernoulli Bladder On
  157. .Run(LoadStep.ReBernoulliBladderOn, () => { return _bernoulliBladderRoutine.Start(true) == RState.Running; }, _delay_1ms)
  158. .WaitWithStopCondition(LoadStep.ReBernoulliBladderOnCheck, () => { return CommonFunction.CheckRoutineEndState(_bernoulliBladderRoutine); },
  159. () => CheckRoutineStopStatus(_bernoulliBladderRoutine, "ReBernoulliBladder On failed"))
  160. //1.9 Tilt Goto Vertical
  161. .Run(LoadStep.TiltGotoVertical, () => { return AxisPosition(_tiltAxis,"VERT"); }, NullFun, _delay_1ms)
  162. .WaitWithStopCondition(LoadStep.TiltGotoVerticalWait, () => { return _tiltAxis.Status == RState.End; },
  163. () => CheckAxisMotionStopStatus(_tiltAxis))
  164. //2.0 CRS Vacuum Check
  165. .Run(LoadStep.CRSVacuumValue, () => { return _vacuumLevelCheckRoutine.Start(true) == RState.Running; }, _delay_1ms)
  166. .WaitWithStopCondition(LoadStep.CRSVacuumValueCheck, () => { return CommonFunction.CheckRoutineEndState(_vacuumLevelCheckRoutine); },
  167. () => CheckRoutineStopStatus(_vacuumLevelCheckRoutine, "CRS Vacuum Check failed"))
  168. //2.1 Shuttle Goto CLOSED
  169. .Run(LoadStep.ShuttleGotoClose, () => { return AxisPosition(_shuttleAxis,"CLOSED"); }, NullFun, _delay_1ms)
  170. .WaitWithStopCondition(LoadStep.ShuttleGotoCloseWait, () => { return _shuttleAxis.Status == RState.End; },
  171. () => CheckAxisMotionStopStatus(_shuttleAxis))
  172. //2.2 Re CRS Vacuum Check
  173. .Run(LoadStep.ReCRSVacuumValue, () => { return _vacuumLevelCheckRoutine.Start(true) == RState.Running; }, _delay_1ms)
  174. .WaitWithStopCondition(LoadStep.ReCRSVacuumValueCheck, () => { return CommonFunction.CheckRoutineEndState(_vacuumLevelCheckRoutine); },
  175. () => CheckRoutineStopStatus(_vacuumLevelCheckRoutine, "Re CRS Vacuum Check failed"))
  176. //2.3 Dor Lock On
  177. .Run(LoadStep.DoorLockOn, () => { return _doorLockRoutine.Start(true) == RState.Running; }, _delay_1ms)
  178. .WaitWithStopCondition(LoadStep.DoorLockOnCheck, () => { return CommonFunction.CheckRoutineEndState(_doorLockRoutine); },
  179. () => CheckRoutineStopStatus(_doorLockRoutine,"Door lock failed"))
  180. //2.4 WS Bladder On
  181. .Run(LoadStep.WSBladderOn, () => { return _whBladderRoutine.Start(true) == RState.Running; }, _delay_1ms)
  182. .WaitWithStopCondition(LoadStep.WSBladderOnCheck, () => { return CommonFunction.CheckRoutineEndState(_whBladderRoutine); },
  183. () => CheckRoutineStopStatus(_whBladderRoutine,"WSBladder On failed"))
  184. //2.5 Trans Bladder On
  185. .Run(LoadStep.TransBladderOn, () => { return _transBladderRoutine.Start(true) == RState.Running; }, _delay_1ms)
  186. .WaitWithStopCondition(LoadStep.TransBladderOnCheck, () => { return CommonFunction.CheckRoutineEndState(_transBladderRoutine); },
  187. () => CheckRoutineStopStatus(_transBladderRoutine,"TransBladder On failed"))
  188. //2.5 Trans High Off
  189. .Run(LoadStep.TransHighOff, () => { return _transHighPressureRoutine.Start(false) == RState.Running; }, _delay_1ms)
  190. .WaitWithStopCondition(LoadStep.TransHighOffCheck, () => { return CommonFunction.CheckRoutineEndState(_transHighPressureRoutine); },
  191. () => CheckRoutineStopStatus(_transHighPressureRoutine, "Trans High Off failed"))
  192. //2.6 CRS Goto SetUp
  193. .Run(LoadStep.CRSGotoSetUp, () => { return AxisPosition(_crsAxis,"Setup"); }, NullFun, _delay_1ms)
  194. .WaitWithStopCondition(LoadStep.CRSGotoSetUpWait, () => { return _crsAxis.Status == RState.End; },
  195. () => CheckAxisMotionStopStatus(_crsAxis))
  196. //2.7 CRS Goto Lock
  197. .Run(LoadStep.CRSGotoLock, () => { return AxisPosition(_crsAxis,"Lock"); }, NullFun, _delay_1ms)
  198. .WaitWithStopCondition(LoadStep.CRSGotoLockWait, () => { return _crsAxis.Status == RState.End; },
  199. () => CheckAxisMotionStopStatus(_crsAxis))
  200. //2.8 Bernoulli N2 Off
  201. .Run(LoadStep.BernoulliN2Off, () => { return _bernoulliN2PressureRoutine.Start(false) == RState.Running; }, _delay_1ms)
  202. .WaitWithStopCondition(LoadStep.BernoulliN2OffCheck, () => { return CommonFunction.CheckRoutineEndState(_bernoulliN2PressureRoutine); },
  203. () => CheckRoutineStopStatus(_bernoulliN2PressureRoutine, "Bernoulli N2 Off failed"))
  204. //2.9 WS Bladder Off
  205. .Run(LoadStep.WSBladderOff, () => { return _whBladderRoutine.Start(false) == RState.Running; }, _delay_1ms)
  206. .WaitWithStopCondition(LoadStep.WSBladderOffCheck, () => { return CommonFunction.CheckRoutineEndState(_whBladderRoutine); },
  207. () => CheckRoutineStopStatus(_whBladderRoutine, "WS Bladder Off failed"))
  208. //3.0 CRS Release Delay
  209. .Delay(LoadStep.CRSReleaseDelay,_crsVacuumReleaseDelayInMilliseconds)
  210. //3.1 CRS Vacuum Off
  211. .Run(LoadStep.CRSVacuumOff, () => { return _vacuumAndLevelCheckRoutineRoutine.Start(false) == RState.Running; }, _delay_1ms)
  212. .WaitWithStopCondition(LoadStep.CRSVacuumOffCheck, () => { return CommonFunction.CheckRoutineEndState(_vacuumAndLevelCheckRoutineRoutine); },
  213. () => CheckRoutineStopStatus(_vacuumAndLevelCheckRoutineRoutine, "LS Vacuum Off failed"))
  214. //3.2 Translate Bladder Release Delay
  215. .Delay(LoadStep.TranslateBladderReleaseDelay,_translateOutDelayInMilliseconds)
  216. //3.3 Trans Bladder Off
  217. .Run(LoadStep.ReTranslateBladderOff, () => { return _transBladderRoutine.Start(false) == RState.Running; }, _delay_1ms)
  218. .WaitWithStopCondition(LoadStep.ReTranslateBladderOffCheck, () => { return CommonFunction.CheckRoutineEndState(_transBladderRoutine); },
  219. () => CheckRoutineStopStatus(_transBladderRoutine, "Trans Bladder Off failed"))
  220. //3.3 Trans High Off
  221. .Run(LoadStep.TranslateHighPresOff, () => { return _transHighPressureRoutine.Start(false) == RState.Running; }, _delay_1ms)
  222. .WaitWithStopCondition(LoadStep.TranslateHighPresOffCheck, () => { return CommonFunction.CheckRoutineEndState(_transHighPressureRoutine); },
  223. () => CheckRoutineStopStatus(_transHighPressureRoutine, "Trans High Off failed"))
  224. //3.4 Home CRS Axis
  225. .Run(LoadStep.HomingCRSAxis, CRSHome,_delay_1ms)
  226. .WaitWithStopCondition(LoadStep.HomingCRSAxisWait, () => { return _crsAxis.Status == RState.End; },
  227. () => CheckCRSHomeStopStatus())
  228. .Run(LoadStep.CRSHomedGotoSetUp, () => { return AxisPosition(_crsAxis,"Setup"); }, _delay_1ms)
  229. .WaitWithStopCondition(LoadStep.CRSHomedGotoSetUpCheck, () => { return _crsAxis.Status == RState.End; },
  230. ()=>CheckAxisMotionStopStatus(_crsAxis))
  231. .End(LoadStep.End,UpdateWaferHolderLipCRSUsed);
  232. return Runner.Status;
  233. }
  234. /// <summary>
  235. /// Wafer Holder Clamp On
  236. /// </summary>
  237. /// <returns></returns>
  238. private bool WaferHolderClampOn()
  239. {
  240. bool result = _loaderCommonDevice.WaferHolderClampOnAction();
  241. if (!result)
  242. {
  243. NotifyError(eEvent.ERR_LOADER, "Wafer Shuttle Clamp on faied", 0);
  244. }
  245. return result;
  246. }
  247. /// <summary>
  248. /// 检验WSSideClampOn异常状态
  249. /// </summary>
  250. /// <returns></returns>
  251. private bool CheckWSSideClampOnStopStatus()
  252. {
  253. bool result = CommonFunction.CheckRoutineStopState(_waferHolderSideClampRoutine);
  254. if (result)
  255. {
  256. NotifyError(eEvent.ERR_LOADER, "WS Clamp On failed", 0);
  257. }
  258. return result;
  259. }
  260. /// <summary>
  261. /// 检验TranslateBladderOff异常状态
  262. /// </summary>
  263. /// <returns></returns>
  264. private bool CheckRoutineStopStatus(IRoutine routine, string error)
  265. {
  266. bool result = CommonFunction.CheckRoutineStopState(routine);
  267. if (result)
  268. {
  269. NotifyError(eEvent.ERR_LOADER, $"{error}", 0);
  270. }
  271. return result;
  272. }
  273. /// <summary>
  274. /// Axis goto position
  275. /// </summary>
  276. /// <param name="axis"></param>
  277. /// <param name="station"></param>
  278. /// <returns></returns>
  279. private bool AxisPosition(JetAxisBase axis, string station)
  280. {
  281. bool result = axis.PositionStation(station);
  282. if (!result)
  283. {
  284. NotifyError(eEvent.ERR_LOADER, $"{axis.Module} goto {station} failed", 0);
  285. }
  286. return result;
  287. }
  288. /// <summary>
  289. /// 检验电机运动异常状态
  290. /// </summary>
  291. /// <param name="axis"></param>
  292. /// <returns></returns>
  293. private bool CheckAxisMotionStopStatus(JetAxisBase axis)
  294. {
  295. bool result = axis.Status == RState.Failed || axis.Status == RState.Timeout;
  296. if (result)
  297. {
  298. NotifyError(eEvent.ERR_LOADER, $"{axis.Module} motion failed", 0);
  299. }
  300. return result;
  301. }
  302. /// <summary>
  303. /// CRS Home
  304. /// </summary>
  305. /// <returns></returns>
  306. private bool CRSHome()
  307. {
  308. bool result = _crsAxis.Home();
  309. if (!result)
  310. {
  311. NotifyError(eEvent.ERR_LOADER, "LS Axis home failed", 0);
  312. }
  313. return result;
  314. }
  315. /// <summary>
  316. /// 检验CRS home异常状态
  317. /// </summary>
  318. /// <returns></returns>
  319. private bool CheckCRSHomeStopStatus()
  320. {
  321. bool result=_crsAxis.Status==RState.Failed||_crsAxis.Status==RState.Timeout;
  322. if (result)
  323. {
  324. NotifyError(eEvent.ERR_LOADER, "LS Axis home failed", 0);
  325. }
  326. return result;
  327. }
  328. /// <summary>
  329. /// 启动
  330. /// </summary>
  331. /// <param name="objs"></param>
  332. /// <returns></returns>
  333. public RState Start(params object[] objs)
  334. {
  335. _crsAxis = GetCrsAxis();
  336. _tiltAxis = GetTiltAxis();
  337. _shuttleAxis= GetShuttleAxis();
  338. _loaderCommonDevice = DEVICE.GetDevice<LoaderCommonDevice>($"Loader1.Common");
  339. _rotationAxis = DEVICE.GetDevice<JetAxisBase>($"{ModuleName.Loader1}.Rotation");
  340. _sideDevice = DEVICE.GetDevice<LoaderSideDevice>($"{Module}.{_side}");
  341. _waferHolderSideClampRoutine = new LoaderCommonWaferHolderSideClampRoutine(ModuleName.Loader1.ToString());
  342. _vacuumLevelCheckRoutine = new LoaderSideVacuumLevelCheckRoutine($"{Module}.{_side}");
  343. _doorLockRoutine = new LoaderSideDoorLockRoutine($"{Module}.{_side}");
  344. _whBladderRoutine = new LoaderSideWhBladderRoutine($"{Module}.{_side}");
  345. _transHighPressureRoutine = new LoaderSideTransHighRoutine($"{Module}.{_side}");
  346. _bernoulliBladderRoutine = new LoaderSideBernoulliBladderRoutine($"{Module}.{_side}");
  347. _transBladderRoutine = new LoaderSideTransBladderRoutine($"{Module}.{_side}");
  348. _bernoulliN2PressureRoutine = new LoaderSideBernoulliN2PressureRoutine($"{Module}.{_side}");
  349. _vacuumAndLevelCheckRoutineRoutine = new LoaderSideVacuumAndLevelCheckRoutineRoutine($"{Module}.{_side}");
  350. if (SC.ContainsItem("Loader1.LSVacuumReleaseDelayInMilliseconds"))
  351. {
  352. _crsVacuumReleaseDelayInMilliseconds = SC.GetValue<int>("Loader1.LSVacuumReleaseDelayInMilliseconds");
  353. }
  354. if (SC.ContainsItem("Loader1.TranslateOutDelayInMilliseconds"))
  355. {
  356. _translateOutDelayInMilliseconds = SC.GetValue<int>("Loader1.TranslateOutDelayInMilliseconds");
  357. }
  358. Runner.Start(Module, "Load");
  359. return RState.Running;
  360. }
  361. /// <summary>
  362. /// 获取Shuttle轴对象
  363. /// </summary>
  364. /// <returns></returns>
  365. private JetAxisBase GetShuttleAxis()
  366. {
  367. switch (_side)
  368. {
  369. case "SideA":
  370. return DEVICE.GetDevice<JetAxisBase>($"{Module}.ShuttleA");
  371. default:
  372. return DEVICE.GetDevice<JetAxisBase>($"{Module}.ShuttleB");
  373. }
  374. }
  375. /// <summary>
  376. /// 获取CRS轴对象
  377. /// </summary>
  378. /// <returns></returns>
  379. private JetAxisBase GetCrsAxis()
  380. {
  381. switch(_side)
  382. {
  383. case "SideA":
  384. return DEVICE.GetDevice<JetAxisBase>($"{Module}.LSA");
  385. default:
  386. return DEVICE.GetDevice<JetAxisBase>($"{Module}.LSB");
  387. }
  388. }
  389. /// <summary>
  390. /// 获取Tilt轴对象
  391. /// </summary>
  392. /// <returns></returns>
  393. private JetAxisBase GetTiltAxis()
  394. {
  395. switch (_side)
  396. {
  397. case "SideA":
  398. return DEVICE.GetDevice<JetAxisBase>($"{Module}.TiltA");
  399. default:
  400. return DEVICE.GetDevice<JetAxisBase>($"{Module}.TiltB");
  401. }
  402. }
  403. /// <summary>
  404. /// 检验前置条件
  405. /// </summary>
  406. /// <returns></returns>
  407. private bool CheckPreCondition()
  408. {
  409. if(!CheckHomeCondition())
  410. {
  411. return false;
  412. }
  413. if(!CheckAxisCondition())
  414. {
  415. return false;
  416. }
  417. if(!StatusCheck())
  418. {
  419. return false;
  420. }
  421. if(!CRSVacuumCheck())
  422. {
  423. return false;
  424. }
  425. return true;
  426. }
  427. /// <summary>
  428. /// 检验Home条件
  429. /// </summary>
  430. /// <returns></returns>
  431. private bool CheckHomeCondition()
  432. {
  433. //检验PUF、Loader Transporter,Robot均Homed
  434. if (ModuleHelper.IsInstalled(ModuleName.PUF1))
  435. {
  436. PUFEntity puf1Entity = Singleton<RouteManager>.Instance.GetModule<PUFEntity>(ModuleName.PUF1.ToString());
  437. if (!puf1Entity.IsHomed)
  438. {
  439. NotifyError(eEvent.ERR_LOADER, "PUF1 is not homed",-1);
  440. return false;
  441. }
  442. }
  443. if (ModuleHelper.IsInstalled(ModuleName.PUF2))
  444. {
  445. PUFEntity puf2Entity = Singleton<RouteManager>.Instance.GetModule<PUFEntity>(ModuleName.PUF2.ToString());
  446. if (!puf2Entity.IsHomed)
  447. {
  448. NotifyError(eEvent.ERR_LOADER, "PUF2 is not homed",-1);
  449. return false;
  450. }
  451. }
  452. if (ModuleHelper.IsInstalled(ModuleName.Transporter2))
  453. {
  454. TransporterEntity loaderTransportEntity = Singleton<RouteManager>.Instance.GetModule<TransporterEntity>(ModuleName.Transporter2.ToString());
  455. if (!loaderTransportEntity.IsHomed)
  456. {
  457. NotifyError(eEvent.ERR_LOADER, "Loader Transporter is not homed",-1);
  458. return false;
  459. }
  460. }
  461. return true;
  462. }
  463. /// <summary>
  464. /// 检验Axis我们的
  465. /// </summary>
  466. /// <param name="side"></param>
  467. /// <returns></returns>
  468. private bool CheckAxisCondition()
  469. {
  470. if(!_rotationAxis.IsHomed)
  471. {
  472. NotifyError(eEvent.ERR_LOADER, $"rotation is not homed",-1);
  473. return false;
  474. }
  475. if (!_shuttleAxis.IsHomed)
  476. {
  477. NotifyError(eEvent.ERR_LOADER, $"{_shuttleAxis.Name} is not homed",-1);
  478. return false;
  479. }
  480. if (!_tiltAxis.IsHomed)
  481. {
  482. NotifyError(eEvent.ERR_LOADER, $"{_tiltAxis.Name} is not homed", -1);
  483. return false;
  484. }
  485. if (!_crsAxis.IsHomed)
  486. {
  487. NotifyError(eEvent.ERR_LOADER, $"{_crsAxis.Name} is not homed",-1);
  488. return false;
  489. }
  490. double rotationPosition = _rotationAxis.MotionData.MotorPosition;
  491. if (!_rotationAxis.CheckPositionIsInStation(rotationPosition, "LOADA") &&
  492. !_rotationAxis.CheckPositionIsInStation(rotationPosition, "SERVICEB"))
  493. {
  494. NotifyError(eEvent.ERR_LOADER, $"rotation {rotationPosition} not in LOADA and SERVICEB", -1);
  495. return false;
  496. }
  497. double shuttlePosition=_shuttleAxis.MotionData.MotorPosition;
  498. if (!_shuttleAxis.CheckPositionIsInStation(shuttlePosition, "OPEN") &&
  499. !_shuttleAxis.CheckPositionIsInStation(shuttlePosition, "OPENB"))
  500. {
  501. NotifyError(eEvent.ERR_LOADER, $"shuttle {shuttlePosition} not in OPEN and OPENB",-1);
  502. return false;
  503. }
  504. double tiltPosition = _tiltAxis.MotionData.MotorPosition;
  505. if (!_tiltAxis.CheckPositionIsInStation(tiltPosition, "HORI"))
  506. {
  507. NotifyError(eEvent.ERR_LOADER, $"tilt {tiltPosition} not in HORI", -1);
  508. return false;
  509. }
  510. double crsPosition=_crsAxis.MotionData.MotorPosition;
  511. if (_crsAxis.CheckPositionIsEmpty(crsPosition))
  512. {
  513. NotifyError(eEvent.ERR_LOADER, $"crs {crsPosition} not at station",-1);
  514. return false;
  515. }
  516. return true;
  517. }
  518. /// <summary>
  519. /// Status Check
  520. /// </summary>
  521. /// <param name="side"></param>
  522. /// <returns></returns>
  523. private bool StatusCheck()
  524. {
  525. //Facility:CDA,N2,Vaccum均Enable且在正常范围
  526. //Side WaferPresent
  527. LoaderSideData sideData = _sideDevice.SideData;
  528. bool isSimulator = SC.GetValue<bool>("System.IsSimulatorMode");
  529. if (!sideData.WaferPresent&&!isSimulator)
  530. {
  531. NotifyError(eEvent.ERR_LOADER, "side wafer not present", -1);
  532. return false;
  533. }
  534. if (sideData.DoorUpperLocked || sideData.DoorLowerLocked)
  535. {
  536. NotifyError(eEvent.ERR_LOADER, "Door Lock is not off", -1);
  537. return false;
  538. }
  539. return true;
  540. }
  541. /// <summary>
  542. /// CRS Vacuum Check
  543. /// </summary>
  544. /// <param name="side"></param>
  545. /// <returns></returns>
  546. private bool CRSVacuumCheck()
  547. {
  548. //CRS Vacuum检验
  549. LoaderSideData sideData = _sideDevice.SideData;
  550. if (!sideData.CRSVacuum)
  551. {
  552. NotifyError(eEvent.ERR_LOADER, "LS Vacuum is off",-1);
  553. return false;
  554. }
  555. if (SC.ContainsItem($"{Module}.LSVacuumHighLimit"))
  556. {
  557. double crsVacuumHighLimit = SC.GetValue<double>($"{Module}.LSVacuumHighLimit");
  558. if (sideData.CRSVacuumValue >= crsVacuumHighLimit || sideData.CRSVacuumValue >= 0)
  559. {
  560. NotifyError(eEvent.ERR_LOADER, "LS Vacuum value is invalid", -1);
  561. return false;
  562. }
  563. }
  564. //WS Bladder,WS Bladder Pressure压力应该大于设定值WSBladderPressure
  565. if (!sideData.WHBladder)
  566. {
  567. NotifyError(eEvent.ERR_LOADER, "WS Bladder is off",-1);
  568. return false;
  569. }
  570. if (SC.ContainsItem($"{Module}.WSBladderPressure"))
  571. {
  572. double wsBladderPressure = SC.GetValue<double>($"{Module}.WSBladderPressure");
  573. if (sideData.WHBladderPressure <= wsBladderPressure)
  574. {
  575. NotifyError(eEvent.ERR_LOADER, $"WS Bladder Pressure value should be more than {wsBladderPressure}", -1);
  576. return false;
  577. }
  578. }
  579. //Translate Bladder/High Pres,且Sensor处于Retracted
  580. if (sideData.TransBladder)
  581. {
  582. NotifyError(eEvent.ERR_LOADER, "TransBladder is on",-1);
  583. return false;
  584. }
  585. if (sideData.TransHigh)
  586. {
  587. NotifyError(eEvent.ERR_LOADER, "Trans High is on", -1);
  588. return false;
  589. }
  590. if (!sideData.TransRetracted)
  591. {
  592. NotifyError(eEvent.ERR_LOADER, "Translate Retracted is off",-1);
  593. return false;
  594. }
  595. //Bernoulli Bladder
  596. if (!sideData.BernoulliBladder)
  597. {
  598. NotifyError(eEvent.ERR_LOADER, "BernoulliBladder is off", -1);
  599. return false;
  600. }
  601. if (sideData.BernoulliExtended)
  602. {
  603. NotifyError(eEvent.ERR_LOADER, "Bernoulli is Extended",-1);
  604. return false;
  605. }
  606. //Bernoulli N2
  607. if (sideData.BernoulliN2)
  608. {
  609. double minBernoulliN2Pressure = SC.GetValue<double>($"{Module}.MinBernoulliN2Pressure");
  610. if (sideData.BernoulliPressure <= minBernoulliN2Pressure)
  611. {
  612. NotifyError(eEvent.ERR_LOADER, "Bernoulli N2 is On,but N2 Pressure is less min setting parameter", -1);
  613. return false;
  614. }
  615. }
  616. //Wafer Shuttle Present
  617. LoaderCommonData commonData = _loaderCommonDevice.CommonData;
  618. if (!commonData.WaferHolderPresent)
  619. {
  620. NotifyError(eEvent.ERR_LOADER, "Wafer Shuttle is absent",-1);
  621. return false;
  622. }
  623. //WS Clamp
  624. if (!commonData.WaferHolderClamp)
  625. {
  626. NotifyError(eEvent.ERR_LOADER, "Wafer Shuttle Clamp is off", -1);
  627. return false;
  628. }
  629. //Drip Tray Fluid
  630. if (commonData.DripTrayFluid)
  631. {
  632. NotifyError(eEvent.ERR_LOADER, "Drip Tray Fluid is on",-1);
  633. return false;
  634. }
  635. return true;
  636. }
  637. /// <summary>
  638. /// 更新WaferHolder LipCRS用量
  639. /// </summary>
  640. /// <returns></returns>
  641. private bool UpdateWaferHolderLipCRSUsed()
  642. {
  643. WaferHolderInfo waferHolderInfo = WaferHolderManager.Instance.GetWaferHolder("Loader");
  644. if (waferHolderInfo != null)
  645. {
  646. if (!string.IsNullOrEmpty(waferHolderInfo.CrsAId)&&_side=="SideA")
  647. {
  648. waferHolderInfo.CrsATotalUses++;
  649. WaferHolderManager.Instance.UpdateWaferHolderInfo(waferHolderInfo);
  650. }
  651. if (!string.IsNullOrEmpty(waferHolderInfo.CrsBId) && _side == "SideB")
  652. {
  653. waferHolderInfo.CrsBTotalUses++;
  654. WaferHolderManager.Instance.UpdateWaferHolderInfo(waferHolderInfo);
  655. }
  656. }
  657. return true;
  658. }
  659. }
  660. }