SunWayEfem.cs 59 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475
  1. using System;
  2. using System.Collections.Generic;
  3. using System.Linq;
  4. using System.Text;
  5. using System.Threading.Tasks;
  6. using System.Collections;
  7. using CyberX8_Core;
  8. using CyberX8_RT.Modules;
  9. using MECF.Framework.Common.CommonData;
  10. using MECF.Framework.Common.Equipment;
  11. using MECF.Framework.Common.SubstrateTrackings;
  12. using Aitex.Sorter.Common;
  13. using Aitex.Core.Common;
  14. using Aitex.Core.RT.SCCore;
  15. using Aitex.Core.RT.Log;
  16. using Aitex.Core.Util;
  17. using MECF.Framework.RT.EquipmentLibrary.HardwareUnits.Robot;
  18. using CyberX8_RT.Devices.YASKAWA;
  19. using System.Collections.Concurrent;
  20. using System.Diagnostics;
  21. using System.Data.SqlTypes;
  22. using System.Windows.Media.Media3D;
  23. using System.ComponentModel;
  24. namespace CyberX8_RT.Devices.EFEM
  25. {
  26. public class SunWayEfem : EfemBase
  27. {
  28. #region 常量
  29. private const string NONE = "None";
  30. #endregion
  31. private RState _status;
  32. private bool _IsHomed;
  33. private bool _bIsUnloadClamp;
  34. private RobotMoveInfo _robotMoveInfo = new RobotMoveInfo();
  35. private readonly Loadport[] _LPMs = new Loadport[3];
  36. private readonly SignalTower _signalT = new SignalTower();
  37. private readonly AsyncSocket _socket;
  38. private EfemMessage _currentMsg;
  39. private EfemMessage _revMsg;
  40. private string _error;
  41. private bool _LiftIsUp = false;
  42. private bool _LiftIsDown = false;
  43. private R_TRIG _busyTrig = new R_TRIG();
  44. private Stopwatch _busyWatch = new Stopwatch();
  45. private bool _isComm;
  46. public override RState Status
  47. {
  48. get
  49. {
  50. _busyTrig.CLK = _status == RState.Running;
  51. if (_busyTrig.Q)
  52. {
  53. _busyWatch.Restart();
  54. }
  55. else if (_busyTrig.M)
  56. {
  57. int timeOut = 5000;
  58. if(_currentMsg.Operation==EfemOperation.Home||_currentMsg.Operation==EfemOperation.Load||
  59. _currentMsg.Operation==EfemOperation.Map)
  60. {
  61. timeOut = 30000;
  62. }
  63. if (_busyWatch.ElapsedMilliseconds > timeOut)
  64. {
  65. _busyWatch.Stop();
  66. _status = RState.Timeout;
  67. }
  68. }
  69. return _status;
  70. }
  71. }
  72. public override bool IsHomed { get { return _IsHomed; } }
  73. public override RobotMoveInfo TMRobotMoveInfo { get { return _robotMoveInfo; } }
  74. public override ILoadport this[ModuleName mod]
  75. {
  76. get
  77. {
  78. if (!ModuleHelper.IsLoadPort(mod))
  79. throw new ApplicationException($"{mod} is NOT Loadport");
  80. return _LPMs[mod - ModuleName.LP1];
  81. }
  82. }
  83. public override bool LiftIsUp { get { return _LiftIsUp; } }
  84. public override bool LiftIsDown { get { return _LiftIsDown; } }
  85. private BlockingCollection<RobotAnimationData> blockingCollection = new BlockingCollection<RobotAnimationData>();
  86. private string _address = "";
  87. public SunWayEfem()
  88. {
  89. _socket = new AsyncSocket("","\r",DataType.Ascii,true);
  90. try
  91. {
  92. _address = SC.GetStringValue($"EFEM.IPAddress");
  93. _socket.Connect(_address);
  94. _socket.OnConnect += Socket_OnConnect;
  95. _socket.OnDataChanged += OnReceiveMessage;
  96. _socket.OnErrorHappened += OnErrorHappen;
  97. }
  98. catch(Exception ex)
  99. {
  100. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, "EFEM", ex.Message);
  101. }
  102. _status = RState.Init;
  103. _IsHomed = false;
  104. _busyTrig.RST = true;
  105. _isComm = false;
  106. _LPMs[0] = new Loadport(ModuleName.LP1, this);
  107. _LPMs[1] = new Loadport(ModuleName.LP2, this);
  108. _LPMs[2] = new Loadport(ModuleName.LP3, this);
  109. CarrierManager.Instance.SubscribeLocation(ModuleName.LP1.ToString(), 1);
  110. CarrierManager.Instance.SubscribeLocation(ModuleName.LP2.ToString(), 1);
  111. CarrierManager.Instance.SubscribeLocation(ModuleName.LP3.ToString(), 1);
  112. WaferManager.Instance.SubscribeLocation(ModuleName.EfemRobot, 2);
  113. WaferManager.Instance.SubscribeLocation(ModuleName.Aligner1, 1);
  114. WaferManager.Instance.SubscribeLocation(ModuleName.LP1, SC.GetValue<int>("EFEM.LoadPort.SlotNumber"));
  115. WaferManager.Instance.SubscribeLocation(ModuleName.LP2, SC.GetValue<int>("EFEM.LoadPort.SlotNumber"));
  116. WaferManager.Instance.SubscribeLocation(ModuleName.LP3, SC.GetValue<int>("EFEM.LoadPort.SlotNumber"));
  117. Task.Run(() =>
  118. {
  119. foreach (var data in blockingCollection.GetConsumingEnumerable())
  120. {
  121. _robotMoveInfo.Action = data.Action;
  122. _robotMoveInfo.ArmTarget = data.Hand == Hand.Blade1 ? RobotArm.ArmA : (data.Hand == Hand.Both ? RobotArm.Both : RobotArm.ArmB);
  123. _robotMoveInfo.BladeTarget = $"{_robotMoveInfo.ArmTarget}.{data.Target}";
  124. System.Threading.Thread.Sleep(600);
  125. }
  126. });
  127. }
  128. private void Socket_OnConnect()
  129. {
  130. LOG.WriteBackgroundLog(eEvent.EV_EFEM_COMMON_INFO, Module.ToString(), $"connect {_address} success");
  131. }
  132. public override void Monitor()
  133. {
  134. }
  135. public override void Terminate()
  136. {
  137. }
  138. public override void Reset()
  139. {
  140. _status = RState.End;
  141. }
  142. public override void SetOnline(bool online)
  143. {
  144. }
  145. public override void SetOnline(ModuleName mod, bool online)
  146. {
  147. }
  148. public override void SetBusy(ModuleName mod, bool online)
  149. {
  150. _status = RState.Running;
  151. }
  152. public override bool HomeAll()
  153. {
  154. if (_status == RState.Running&&_currentMsg!=null)
  155. {
  156. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"Current Msg {_currentMsg.Operation} is Running,cannot home All");
  157. return false;
  158. }
  159. //判断socket是否链接
  160. if (!_socket.IsConnected)
  161. {
  162. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  163. return false ;
  164. }
  165. //判断机台是否准备就绪
  166. if (!_isComm)
  167. {
  168. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  169. return false;
  170. }
  171. _currentMsg = new EfemMessage
  172. {
  173. Module = ModuleName.EFEM,
  174. Operation = EfemOperation.Home,
  175. Head = EfemMessage.MsgHead.MOV,
  176. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[ModuleName.EFEM] }
  177. };
  178. _status = RState.Running;
  179. string data = _currentMsg.ToString();
  180. SetRobotMovingInfo(RobotAction.Homing, Hand.Both, ModuleName.EFEM);
  181. return _socket.Write(data);
  182. }
  183. public override bool Home(ModuleName mod)
  184. {
  185. if (_status == RState.Running && _currentMsg != null)
  186. {
  187. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"Current Msg {_currentMsg.Operation} is Running,cannot home {mod}");
  188. return false;
  189. }
  190. //判断socket是否链接
  191. if (!_socket.IsConnected)
  192. {
  193. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  194. return false;
  195. }
  196. //判断机台是否准备就绪
  197. if (!_isComm)
  198. {
  199. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  200. return false;
  201. }
  202. _currentMsg = new EfemMessage
  203. {
  204. Module = mod,
  205. Operation = EfemOperation.Home,
  206. Head = EfemMessage.MsgHead.MOV,
  207. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  208. };
  209. if(mod == ModuleName.EfemRobot) SetRobotMovingInfo(RobotAction.Homing, Hand.Blade1, ModuleName.EfemRobot);
  210. _status = RState.Running;
  211. return _socket.Write(_currentMsg.ToString());
  212. }
  213. public override bool OriginalSearch(ModuleName mod)
  214. {
  215. return true;
  216. }
  217. public override bool CheckWaferPresence()
  218. {
  219. if (!CheckEfemStatus())
  220. return false;
  221. _currentMsg = new EfemMessage
  222. {
  223. Module = ModuleName.EFEM,
  224. Operation = EfemOperation.StateTrack,
  225. Head = EfemMessage.MsgHead.GET,
  226. Parameters = new List<string> { "TRACK" }
  227. };
  228. _status = RState.Running;
  229. return _socket.Write(_currentMsg.ToString());
  230. }
  231. public override string GetWaferPresence()
  232. {
  233. return "";
  234. }
  235. public override bool Halt()
  236. {
  237. //判断socket是否链接
  238. if (!_socket.IsConnected)
  239. {
  240. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  241. return false;
  242. }
  243. _currentMsg = new EfemMessage
  244. {
  245. Module = ModuleName.EFEM,
  246. Operation = EfemOperation.Abort,
  247. Head = EfemMessage.MsgHead.MOV,
  248. };
  249. return _socket.Write(_currentMsg.ToString());
  250. }
  251. public override bool ClearError()
  252. {
  253. //判断机台是否准备就绪
  254. if (!_isComm)
  255. {
  256. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  257. return false;
  258. }
  259. //判断socket是否链接
  260. if (!_socket.IsConnected)
  261. {
  262. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  263. return false;
  264. }
  265. _currentMsg = new EfemMessage
  266. {
  267. Module = ModuleName.EFEM,
  268. Operation = EfemOperation.ClearError,
  269. Head = EfemMessage.MsgHead.SET,
  270. Parameters = new List<string> { "CLEAR" }
  271. };
  272. _status = RState.Running;
  273. return _socket.Write(_currentMsg.ToString());
  274. }
  275. public override bool CloseBuzzer()
  276. {
  277. //判断机台是否准备就绪
  278. if (!_isComm)
  279. {
  280. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  281. return false;
  282. }
  283. //判断socket是否链接
  284. if (!_socket.IsConnected)
  285. {
  286. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  287. return false;
  288. }
  289. _currentMsg = new EfemMessage
  290. {
  291. Module = ModuleName.EFEM,
  292. Operation = EfemOperation.Light,
  293. Head = EfemMessage.MsgHead.SET,
  294. Parameters = new List<string> { Constant.STOWER, LightType.BUZZER1.ToString(), "OFF" }
  295. };
  296. _status = RState.Running;
  297. return _socket.Write(_currentMsg.ToString());
  298. }
  299. public override bool PickExtend(ModuleName chamber, int slot, Hand hand)
  300. {
  301. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support {EfemConstant.OperationString[EfemOperation.Extend]}");
  302. return false;
  303. }
  304. public override bool PickRetract(ModuleName chamber, int slot, Hand hand)
  305. {
  306. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support {EfemConstant.OperationString[EfemOperation.Extend]}");
  307. return false;
  308. }
  309. public override bool PlaceExtend(ModuleName chamber, int slot, Hand hand)
  310. {
  311. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support {EfemConstant.OperationString[EfemOperation.Extend]}");
  312. return false;
  313. }
  314. public override bool PlaceRetract(ModuleName chamber, int slot, Hand hand)
  315. {
  316. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support {EfemConstant.OperationString[EfemOperation.Extend]}");
  317. return false;
  318. }
  319. public override bool GotoMap(ModuleName mod, Hand hand,string extend="EX")
  320. {
  321. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support GotoMap");
  322. return false;
  323. }
  324. public override bool RequestMapResult(ModuleName mod)
  325. {
  326. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support RequestMapResult");
  327. return false;
  328. }
  329. public override bool Pick(ModuleName station, int slot, Hand hand)
  330. {
  331. //判断机台是否准备就绪
  332. if (!_isComm)
  333. {
  334. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  335. return false;
  336. }
  337. //判断socket是否链接
  338. if (!_socket.IsConnected)
  339. {
  340. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  341. return false;
  342. }
  343. //判断Loadport的门是否打开
  344. if (ModuleHelper.IsLoadPort(station) && !_LPMs[station - ModuleName.LP1].IsDoorOpened)
  345. {
  346. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"{station}'s Door is Closed, Cannot Execute Pick Action");
  347. return false;
  348. }
  349. if (!CheckEfemStatus())
  350. return false;
  351. Position SrcPos = new Position { Module = station, Slot = (byte)slot };
  352. _currentMsg = new EfemMessage
  353. {
  354. Operation = EfemOperation.Pick,
  355. Head = EfemMessage.MsgHead.MOV,
  356. Parameters = new List<string>
  357. {
  358. SunWayMessageHandler.Instance.ToHWString(SrcPos),
  359. SunWayMessageHandler.Instance.ArmString[hand]
  360. }
  361. };
  362. _status = RState.Running;
  363. SetRobotMovingInfo(RobotAction.Picking, hand, station);
  364. return _socket.Write(_currentMsg.ToString());
  365. }
  366. public override bool Place(ModuleName station, int slot, Hand hand)
  367. {
  368. //判断机台是否准备就绪
  369. if (!_isComm)
  370. {
  371. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  372. return false;
  373. }
  374. //判断socket是否链接
  375. if (!_socket.IsConnected)
  376. {
  377. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  378. return false;
  379. }
  380. //判断Loadport的门是否打开
  381. if (ModuleHelper.IsLoadPort(station) && !_LPMs[station - ModuleName.LP1].IsDoorOpened)
  382. {
  383. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"{station}'s Door is Closed, Cannot Execute Pick Action");
  384. return false;
  385. }
  386. if (!CheckEfemStatus())
  387. return false;
  388. Position DestPos = new Position { Module = station, Slot = (byte)slot };
  389. _currentMsg = new EfemMessage
  390. {
  391. Operation = EfemOperation.Place,
  392. Head = EfemMessage.MsgHead.MOV,
  393. Parameters = new List<string>
  394. {
  395. SunWayMessageHandler.Instance.ToHWString(DestPos),
  396. SunWayMessageHandler.Instance.ArmString[hand]
  397. }
  398. };
  399. _status = RState.Running;
  400. SetRobotMovingInfo(RobotAction.Placing, hand, station);
  401. return _socket.Write(_currentMsg.ToString());
  402. }
  403. public override bool Goto(ModuleName station, Hand hand, string updown = "UP")
  404. {
  405. if (!CheckEfemStatus())
  406. return false;
  407. //判断socket是否链接
  408. if (!_socket.IsConnected)
  409. {
  410. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  411. return false;
  412. }
  413. Position DestPos = new Position { Module = station, Slot = (byte)0 };
  414. _currentMsg = new EfemMessage
  415. {
  416. Operation = EfemOperation.Goto,
  417. Head = EfemMessage.MsgHead.MOV,
  418. Parameters = new List<string>
  419. {
  420. SunWayMessageHandler.Instance.ToHWString(DestPos),
  421. SunWayMessageHandler.Instance.ArmString[hand],
  422. updown
  423. }
  424. };
  425. _status = RState.Running;
  426. return _socket.Write(_currentMsg.ToString());
  427. }
  428. public override bool Grip(Hand blade, bool isGrip)
  429. {
  430. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support {EfemConstant.OperationString[EfemOperation.Grip]}");
  431. return false;
  432. }
  433. public override bool Map(ModuleName mod)
  434. {
  435. //判断机台是否准备就绪
  436. if (!_isComm)
  437. {
  438. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  439. return false;
  440. }
  441. //判断socket是否链接
  442. if (!_socket.IsConnected)
  443. {
  444. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  445. return false;
  446. }
  447. if (!CheckEfemStatus())
  448. return false;
  449. _currentMsg = new EfemMessage
  450. {
  451. Operation = EfemOperation.Map,
  452. Head = EfemMessage.MsgHead.MOV,
  453. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  454. };
  455. _status = RState.Running;
  456. return _socket.Write(_currentMsg.ToString());
  457. }
  458. public override bool Vacuum(ModuleName mod,bool VacuumState)
  459. {
  460. //判断机台是否准备就绪
  461. if (!_isComm)
  462. {
  463. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  464. return false;
  465. }
  466. //判断socket是否链接
  467. if (!_socket.IsConnected)
  468. {
  469. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  470. return false;
  471. }
  472. string strVacuum = VacuumState ? "ON" : "OFF";
  473. _currentMsg = new EfemMessage
  474. {
  475. Operation = EfemOperation.Vacuum,
  476. Head = EfemMessage.MsgHead.MOV,
  477. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod],strVacuum }
  478. };
  479. _status = RState.Running;
  480. return _socket.Write(_currentMsg.ToString());
  481. }
  482. public override bool GetWaferSize(ModuleName mod)
  483. {
  484. if (!CheckEfemStatus())
  485. return false;
  486. //判断机台是否准备就绪
  487. if (!_isComm)
  488. {
  489. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  490. return false;
  491. }
  492. //判断socket是否链接
  493. if (!_socket.IsConnected)
  494. {
  495. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  496. return false;
  497. }
  498. _currentMsg = new EfemMessage
  499. {
  500. Operation = EfemOperation.Size,
  501. Head = EfemMessage.MsgHead.GET,
  502. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  503. };
  504. _status = RState.Running;
  505. return _socket.Write(_currentMsg.ToString());
  506. }
  507. public override bool SetWaferSize(ModuleName mod, int WaferSize)
  508. {
  509. if (!CheckEfemStatus())
  510. return false;
  511. //判断机台是否准备就绪
  512. if (!_isComm)
  513. {
  514. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  515. return false;
  516. }
  517. //判断socket是否链接
  518. if (!_socket.IsConnected)
  519. {
  520. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  521. return false;
  522. }
  523. _currentMsg = new EfemMessage
  524. {
  525. Operation = EfemOperation.Size,
  526. Head = EfemMessage.MsgHead.SET,
  527. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod], WaferSize.ToString() }
  528. };
  529. _status = RState.Running;
  530. return _socket.Write(_currentMsg.ToString());
  531. }
  532. public override bool SetPinUp(ModuleName mod)
  533. {
  534. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support {EfemConstant.OperationString[EfemOperation.Lift]}");
  535. return false;
  536. }
  537. public override bool SetPinDown(ModuleName mod)
  538. {
  539. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support {EfemConstant.OperationString[EfemOperation.Lift]}");
  540. return false;
  541. }
  542. public override bool SetAlignAngle(ModuleName mod, double angle)
  543. {
  544. if (!CheckEfemStatus())
  545. return false;
  546. //判断机台是否准备就绪
  547. if (!_isComm)
  548. {
  549. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  550. return false;
  551. }
  552. //判断socket是否链接
  553. if (!_socket.IsConnected)
  554. {
  555. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  556. return false;
  557. }
  558. _currentMsg = new EfemMessage
  559. {
  560. Operation = EfemOperation.Align,
  561. Head = EfemMessage.MsgHead.SET,
  562. Parameters = new List<string>
  563. {
  564. SunWayMessageHandler.Instance.ModuleString[mod],
  565. angle.ToString("000.00")
  566. }
  567. };
  568. _status = RState.Running;
  569. return _socket.Write(_currentMsg.ToString());
  570. }
  571. public override bool SetRobotSpeed(ModuleName mod, int speed)
  572. {
  573. if (!CheckEfemStatus())
  574. return false;
  575. //判断机台是否准备就绪
  576. if (!_isComm)
  577. {
  578. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  579. return false;
  580. }
  581. //判断socket是否链接
  582. if (!_socket.IsConnected)
  583. {
  584. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  585. return false;
  586. }
  587. _currentMsg = new EfemMessage
  588. {
  589. Operation = EfemOperation.Speed,
  590. Head = EfemMessage.MsgHead.SET,
  591. Parameters = new List<string>
  592. {
  593. SunWayMessageHandler.Instance.ModuleString[mod],
  594. speed.ToString()
  595. }
  596. };
  597. _status = RState.Running;
  598. return _socket.Write(_currentMsg.ToString());
  599. }
  600. public override bool RobotPowerOn(ModuleName mod, bool Status)
  601. {
  602. //判断机台是否准备就绪
  603. if (!_isComm)
  604. {
  605. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  606. return false;
  607. }
  608. //判断socket是否链接
  609. if (!_socket.IsConnected)
  610. {
  611. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  612. return false;
  613. }
  614. if (!CheckEfemStatus())
  615. return false;
  616. string status = "ON";
  617. if (!Status)
  618. {
  619. status = "OFF";
  620. }
  621. _currentMsg = new EfemMessage
  622. {
  623. Operation = EfemOperation.PowerOn,
  624. Head = EfemMessage.MsgHead.MOV,
  625. Parameters = new List<string>
  626. {
  627. SunWayMessageHandler.Instance.ModuleString[mod],
  628. status
  629. }
  630. };
  631. _status = RState.Running;
  632. return _socket.Write(_currentMsg.ToString());
  633. }
  634. public override bool Align(ModuleName mod, double angle, float delayTime, WaferSize size)
  635. {
  636. //判断机台是否准备就绪
  637. if (!_isComm)
  638. {
  639. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  640. return false;
  641. }
  642. //判断socket是否链接
  643. if (!_socket.IsConnected)
  644. {
  645. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  646. return false;
  647. }
  648. if (!CheckEfemStatus())
  649. return false;
  650. _currentMsg = new EfemMessage
  651. {
  652. Operation = EfemOperation.Align,
  653. Head = EfemMessage.MsgHead.MOV,
  654. Parameters = new List<string>
  655. {
  656. SunWayMessageHandler.Instance.ModuleString[mod]
  657. }
  658. };
  659. _status = RState.Running;
  660. return _socket.Write(_currentMsg.ToString());
  661. }
  662. public override bool SetLamp(LightType light, LightStatus status)
  663. {
  664. if (!_isComm)
  665. {
  666. return false;
  667. }
  668. //判断socket是否链接
  669. if (!_socket.IsConnected)
  670. {
  671. return false;
  672. }
  673. EfemMessage currentMsg = new EfemMessage
  674. {
  675. Module = ModuleName.EFEM,
  676. Operation = EfemOperation.Light,
  677. Head = EfemMessage.MsgHead.SET,
  678. Parameters = new List<string> { Constant.STOWER, light.ToString(), status.ToString() }
  679. };
  680. return _socket.Write(currentMsg.ToString());
  681. }
  682. public override bool Load(ModuleName mod)
  683. {
  684. //判断机台是否准备就绪
  685. if (!_isComm)
  686. {
  687. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  688. return false;
  689. }
  690. //判断socket是否链接
  691. if (!_socket.IsConnected)
  692. {
  693. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  694. return false;
  695. }
  696. if (!CheckEfemStatus())
  697. return false;
  698. _currentMsg = new EfemMessage
  699. {
  700. Module = mod,
  701. Operation = EfemOperation.Load,
  702. Head = EfemMessage.MsgHead.MOV,
  703. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  704. };
  705. _status = RState.Running;
  706. return _socket.Write(_currentMsg.ToString());
  707. }
  708. public override bool Unload(ModuleName mod)
  709. {
  710. //判断机台是否准备就绪
  711. if (!_isComm)
  712. {
  713. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  714. return false;
  715. }
  716. //判断socket是否链接
  717. if (!_socket.IsConnected)
  718. {
  719. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  720. return false;
  721. }
  722. if (!CheckEfemStatus())
  723. return false;
  724. _currentMsg = new EfemMessage
  725. {
  726. Module = mod,
  727. Operation = EfemOperation.Unload,
  728. Head = EfemMessage.MsgHead.MOV,
  729. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  730. };
  731. _status = RState.Running;
  732. return _socket.Write(_currentMsg.ToString());
  733. }
  734. public override bool ReadCarrierId(ModuleName mod)
  735. {
  736. //判断机台是否准备就绪
  737. if (!_isComm)
  738. {
  739. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  740. return false;
  741. }
  742. //判断socket是否链接
  743. if (!_socket.IsConnected)
  744. {
  745. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  746. return false;
  747. }
  748. if (!CheckEfemStatus())
  749. return false;
  750. _currentMsg = new EfemMessage
  751. {
  752. Module = mod,
  753. Operation = EfemOperation.CarrierId,
  754. Head = EfemMessage.MsgHead.GET,
  755. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  756. };
  757. _status = RState.Running;
  758. return _socket.Write(_currentMsg.ToString());
  759. }
  760. public override bool WriteCarrierId(ModuleName mod, string id)
  761. {
  762. if (!CheckEfemStatus())
  763. return false;
  764. //判断机台是否准备就绪
  765. if (!_isComm)
  766. {
  767. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  768. return false;
  769. }
  770. //判断socket是否链接
  771. if (!_socket.IsConnected)
  772. {
  773. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  774. return false;
  775. }
  776. _currentMsg = new EfemMessage
  777. {
  778. Module = mod,
  779. Operation = EfemOperation.CarrierId,
  780. Head = EfemMessage.MsgHead.SET,
  781. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod], id }
  782. };
  783. _status = RState.Running;
  784. return _socket.Write(_currentMsg.ToString());
  785. }
  786. public override bool ReadTagData(ModuleName mod)
  787. {
  788. return ReadCarrierId(mod);
  789. }
  790. public override bool WriteTagData(ModuleName mod, string tagData)
  791. {
  792. return WriteCarrierId(mod, tagData);
  793. }
  794. public override bool Dock(ModuleName mod)
  795. {
  796. //判断机台是否准备就绪
  797. if (!_isComm)
  798. {
  799. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  800. return false;
  801. }
  802. //判断socket是否链接
  803. if (!_socket.IsConnected)
  804. {
  805. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  806. return false;
  807. }
  808. if (!CheckEfemStatus())
  809. return false;
  810. _currentMsg = new EfemMessage
  811. {
  812. Module = mod,
  813. Operation = EfemOperation.Dock,
  814. Head = EfemMessage.MsgHead.MOV,
  815. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  816. };
  817. _status = RState.Running;
  818. return _socket.Write(_currentMsg.ToString());
  819. }
  820. public override bool Undock(ModuleName mod)
  821. {
  822. //判断机台是否准备就绪
  823. if (!_isComm)
  824. {
  825. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  826. return false;
  827. }
  828. //判断socket是否链接
  829. if (!_socket.IsConnected)
  830. {
  831. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  832. return false;
  833. }
  834. if (!CheckEfemStatus())
  835. return false;
  836. _currentMsg = new EfemMessage
  837. {
  838. Module = mod,
  839. Operation = EfemOperation.Undock,
  840. Head = EfemMessage.MsgHead.MOV,
  841. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  842. };
  843. _status = RState.Running;
  844. return _socket.Write(_currentMsg.ToString());
  845. }
  846. public override bool Clamp(ModuleName mod, bool isUnloadClamp)
  847. {
  848. //判断机台是否准备就绪
  849. if (!_isComm)
  850. {
  851. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  852. return false;
  853. }
  854. //判断socket是否链接
  855. if (!_socket.IsConnected)
  856. {
  857. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  858. return false;
  859. }
  860. if (!CheckEfemStatus())
  861. return false;
  862. _currentMsg = new EfemMessage
  863. {
  864. Module = mod,
  865. Operation = EfemOperation.Clamp,
  866. Head = EfemMessage.MsgHead.MOV,
  867. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  868. };
  869. _status = RState.Running;
  870. _bIsUnloadClamp = isUnloadClamp;
  871. return _socket.Write(_currentMsg.ToString());
  872. }
  873. public override bool Unclamp(ModuleName mod)
  874. {
  875. //判断机台是否准备就绪
  876. if (!_isComm)
  877. {
  878. LOG.WriteLog(eEvent.ERROR_EFEM_NOREADY, Module.ToString(), "No \"CommReady\" Message Received,Cannot Execute Action");
  879. return false;
  880. }
  881. //判断socket是否链接
  882. if (!_socket.IsConnected)
  883. {
  884. LOG.WriteLog(eEvent.ERROR_EFEM_COMMUNICATION, Module.ToString(), $"Socket is not Conntected");
  885. return false;
  886. }
  887. if (!CheckEfemStatus())
  888. return false;
  889. _currentMsg = new EfemMessage
  890. {
  891. Module = mod,
  892. Operation = EfemOperation.Unclamp,
  893. Head = EfemMessage.MsgHead.MOV,
  894. Parameters = new List<string> { SunWayMessageHandler.Instance.ModuleString[mod] }
  895. };
  896. _status = RState.Running;
  897. return _socket.Write(_currentMsg.ToString());
  898. }
  899. public override bool SetThickness(ModuleName mod, string thickness)
  900. {
  901. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), $"System cannot support {EfemConstant.OperationString[EfemOperation.SetThickness]}");
  902. return false;
  903. }
  904. public override void SetRobotMovingInfo(RobotAction action, Hand hand, ModuleName target)
  905. {
  906. blockingCollection.Add(new RobotAnimationData(action, hand, target));
  907. }
  908. private void OnReceiveMessage(string RevMsg)
  909. {
  910. LOG.WriteBackgroundLog(eEvent.EV_EFEM_COMMON_INFO, Module.ToString(), RevMsg.Replace("\r",""));
  911. if (!_isComm)
  912. {
  913. //检验是否收到CommReady信号
  914. if (RevMsg.IndexOf("COMM", StringComparison.OrdinalIgnoreCase) >= 0)
  915. {
  916. _isComm = true;
  917. }
  918. }
  919. string[] msgs = RevMsg.Split('\r');
  920. foreach (var msg in msgs)
  921. {
  922. if (string.IsNullOrWhiteSpace(msg)) continue;
  923. EfemMessage rec_msg = SunWayMessageHandler.Instance.ToMessage(msg);
  924. switch (rec_msg.Head)
  925. {
  926. case EfemMessage.MsgHead.ACK:
  927. if (msg.Contains("ERROR"))
  928. {
  929. _revMsg = rec_msg;
  930. }
  931. break;
  932. case EfemMessage.MsgHead.INF:
  933. // 收到INF之后发送ACK确认
  934. string strACK = rec_msg.RawString.Replace("INF", "ACK");
  935. SendBack(strACK);
  936. LOG.WriteBackgroundLog(eEvent.EV_EFEM_COMMON_INFO, Module.ToString(), strACK);
  937. //提示当前机械臂速度设置情况
  938. if (strACK.Contains("SPEED"))
  939. {
  940. string[] SpeedInf = rec_msg.RawString.Split('/');
  941. LOG.Write(eEvent.INFO_PROCESS, ModuleName.Robot, $"Robot Speed is {SpeedInf[SpeedInf.Length-1]}");
  942. }
  943. //提示当前机械臂电源情况
  944. if (strACK.Contains("SERVOS"))
  945. {
  946. string[] PowerInf = rec_msg.RawString.Split('/');
  947. LOG.Write(eEvent.INFO_PROCESS, ModuleName.Robot, $"Robot Power is {PowerInf[PowerInf.Length - 1]}");
  948. }
  949. EfemMessage ack_msg = SunWayMessageHandler.Instance.ToMessage(strACK);
  950. ack_msg.Direct = MsgDirection.To;
  951. _revMsg = rec_msg;
  952. OnCommandUpdated(rec_msg);
  953. SetRobotMovingInfo(RobotAction.None, Hand.Both, ModuleName.EfemRobot);
  954. break;
  955. case EfemMessage.MsgHead.EVT:
  956. OnEventUpdated(new EfemEventArgs
  957. {
  958. EvtStr = rec_msg.ToParamString(),
  959. Module = rec_msg.Module,
  960. CommandType = rec_msg.Operation,
  961. DataList = rec_msg.Data
  962. });
  963. if (rec_msg.Operation == EfemOperation.Home)
  964. {
  965. SetRobotMovingInfo(RobotAction.Homing, Hand.Both, ModuleName.EFEM);
  966. }
  967. if (rec_msg.Operation == EfemOperation.Error)
  968. {
  969. OnErrorOccurred(rec_msg);
  970. }
  971. break;
  972. case EfemMessage.MsgHead.NAK:
  973. case EfemMessage.MsgHead.CAN:
  974. case EfemMessage.MsgHead.ABS:
  975. OnErrorOccurred(rec_msg);
  976. break;
  977. }
  978. }
  979. }
  980. private void OnErrorHappen(ErrorEventArgs args)
  981. {
  982. _status = RState.Failed;
  983. if(_error!=args.Reason)
  984. {
  985. _error=args.Reason;
  986. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, Module, $"{Module} {_error}");
  987. }
  988. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error);
  989. }
  990. private void OnErrorOccurred(EfemMessage message)
  991. {
  992. string description = string.Empty;
  993. string str = "";
  994. switch (message.Head)
  995. {
  996. case EfemMessage.MsgHead.NAK:
  997. description = Constant.SunWayFactorString.ContainsKey(message.Factor) ? Constant.SunWayFactorString[message.Factor]:message.Factor;
  998. break;
  999. case EfemMessage.MsgHead.CAN:
  1000. description = Constant.SunWayFactorString.ContainsKey(message.Factor) ? Constant.SunWayFactorString[message.Factor] : message.Factor;
  1001. str = message.Data.Count != 0 ? message.Data[0] : "";
  1002. break;
  1003. case EfemMessage.MsgHead.ABS:
  1004. description = message.Factor;
  1005. str = message.Data.Count != 0 ? String.Join(" ", message.Data.ToArray()):"";
  1006. break;
  1007. case EfemMessage.MsgHead.EVT:
  1008. str= message.Data.Count != 0 ? String.Join(" ", message.Data.ToArray()) : "";
  1009. break;
  1010. }
  1011. _status = RState.Failed;
  1012. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error,description);
  1013. if (message.Head == EfemMessage.MsgHead.NAK || message.Head == EfemMessage.MsgHead.CAN)
  1014. {
  1015. eEvent eEvent = GetFactorEventId(message.Factor);
  1016. LOG.Write(eEvent, ModuleName.EFEM, $"{description}, [{str}]");
  1017. }
  1018. else
  1019. {
  1020. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM, $"{description}, [{str}]");
  1021. }
  1022. }
  1023. /// <summary>
  1024. /// 根据Factor获取相应的eEventId
  1025. /// </summary>
  1026. /// <param name="factor"></param>
  1027. /// <returns></returns>
  1028. private eEvent GetFactorEventId(string factor)
  1029. {
  1030. string str = $"ERR_EFEM_{factor}";
  1031. if(Enum.TryParse(str,out eEvent result))
  1032. {
  1033. return result;
  1034. }
  1035. else
  1036. {
  1037. return eEvent.ERR_EFEM_COMMON_FAILED;
  1038. }
  1039. }
  1040. private void OnEventUpdated(EfemEventArgs eArg)
  1041. {
  1042. switch (eArg.CommandType)
  1043. {
  1044. case EfemOperation.SigStatus:
  1045. // EVT:SIGSTAT/Parameter/DATA1/DATA2;
  1046. string sParam = eArg.DataList[0];
  1047. // DATA1 & DATA2
  1048. int nData1 = Convert.ToInt32(eArg.DataList[1], 16);
  1049. int nData2 = Convert.ToInt32(eArg.DataList[2], 16);
  1050. BitArray baData1 = new BitArray(new int[] { nData1 });
  1051. BitArray baData2 = new BitArray(new int[] { nData2 });
  1052. if (0 == string.Compare(sParam, Constant.SYS, true))
  1053. {
  1054. // EVT:SIGSTAT/System/00000000/00000004;
  1055. // DATA1
  1056. if (!baData1[0]) // Bit[0] ON=Normal, OFF=Abnormal
  1057. {
  1058. string error = "EFEM Door is OFF Alarm";
  1059. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM, error);
  1060. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error,error);
  1061. }
  1062. if (!baData1[1]) // Bit[0] ON=Normal, OFF=Abnormal
  1063. {
  1064. string error = "EFEM Vacuum Detection is OFF Alarm";
  1065. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM, error);
  1066. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error, error);
  1067. }
  1068. if (!baData1[2]) // Bit[2] ON=Normal, OFF=Abnormal
  1069. {
  1070. string error = "EFEM Air Detection is OFF Alarm";
  1071. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM, error);
  1072. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error,error);
  1073. }
  1074. if (!baData1[3]) // Bit[3] ON=Normal, OFF=Abnormal
  1075. {
  1076. string error = "EFEM OnlineMode is OFF Alarm";
  1077. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM, error);
  1078. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error,error);
  1079. }
  1080. if (baData1[4]) // Bit[4] ON=Abnormal, OFF=Normal
  1081. {
  1082. string error = "EFEM MaintenanceMode is ON Alarm";
  1083. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM, error);
  1084. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error, error);
  1085. }
  1086. if (baData1[5]) // Bit[5] ON=Abnormal, OFF=Normal
  1087. {
  1088. string error = "EFEM System Wafer Stick-out1 Alarm";
  1089. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM, error);
  1090. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error, error);
  1091. }
  1092. if (baData1[6]) // Bit[6] ON=Abnormal, OFF=Normal
  1093. {
  1094. string error = "EFEM System Wafer Stick-out2 Alarm";
  1095. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM, error);
  1096. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error,error);
  1097. }
  1098. if (baData1[7]) // Bit[7] ON=Abnormal, OFF=Normal
  1099. {
  1100. string error = "EFEM Emergency Stop Signal Alarm";
  1101. LOG.Write(eEvent.ERR_EFEM_COMMON_FAILED, ModuleName.EFEM,error);
  1102. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error,error);
  1103. }
  1104. // DATA2
  1105. _signalT.ChangeLightStatus(LightType.BUZZER1, baData2[0] ? LightStatus.ON : LightStatus.OFF);
  1106. _signalT.ChangeLightStatus(LightType.BLUE, baData2[1] ? LightStatus.ON : LightStatus.OFF);
  1107. _signalT.ChangeLightStatus(LightType.GREEN, baData2[2] ? LightStatus.ON : LightStatus.OFF);
  1108. _signalT.ChangeLightStatus(LightType.YELLOW, baData2[3] ? LightStatus.ON : LightStatus.OFF);
  1109. _signalT.ChangeLightStatus(LightType.RED, baData2[4] ? LightStatus.ON : LightStatus.OFF);
  1110. _signalT.ChangeLightStatus(LightType.BLUE, baData2[6] ? LightStatus.BLINK : LightStatus.OFF);
  1111. _signalT.ChangeLightStatus(LightType.GREEN, baData2[7] ? LightStatus.BLINK : LightStatus.OFF);
  1112. _signalT.ChangeLightStatus(LightType.YELLOW, baData2[8] ? LightStatus.BLINK : LightStatus.OFF);
  1113. _signalT.ChangeLightStatus(LightType.RED, baData2[9] ? LightStatus.BLINK : LightStatus.OFF);
  1114. //屏蔽LP光栅信号
  1115. /* EFEM 程序中目前没有实现
  1116. _RobotErr.CLK = baData2[27]; // bit 27
  1117. bool bArmNotExtendLLA = baData2[30]; // bit 30
  1118. bool bArmNotExtendLLB = baData2[31]; // bit 31
  1119. */
  1120. } // system event
  1121. else
  1122. {
  1123. // placement & present
  1124. bool bPlacement = baData1[0]; // bit 0
  1125. bool bPresence = baData1[0]; // bit 1
  1126. bool bArrived = bPlacement && bPresence;
  1127. _LPMs[eArg.Module - ModuleName.LP1].UpdateWaferArrive(bArrived);
  1128. _LPMs[eArg.Module - ModuleName.LP1].IsClamped = baData1[1];
  1129. _LPMs[eArg.Module - ModuleName.LP1].IsDocked = baData1[2];
  1130. _LPMs[eArg.Module - ModuleName.LP1].IsDoorOpened = !baData1[5];
  1131. //_LPMs[eArg.Module - ModuleName.LP1].HandleEvent(eArg);
  1132. } // FOUP EVENT
  1133. break;
  1134. case EfemOperation.GetWaferInfo:
  1135. //MADPT
  1136. //lp
  1137. if (ModuleHelper.IsLoadPort(eArg.Module))
  1138. {
  1139. _LPMs[eArg.Module - ModuleName.LP1].HandleEvent(eArg);
  1140. }
  1141. // BF
  1142. else
  1143. {
  1144. MapBufferHandleEvent(eArg);
  1145. }
  1146. //buffer
  1147. break;
  1148. case EfemOperation.Align:
  1149. //ALIGN
  1150. MapBufferHandleEvent(eArg);
  1151. break;
  1152. default:
  1153. break;
  1154. }
  1155. }
  1156. public void MapBufferHandleEvent(EfemEventArgs eArg)
  1157. {
  1158. string sWaferInfo = eArg.DataList[0];
  1159. for (byte index = 0; index < sWaferInfo.Length; index++)
  1160. {
  1161. int waferState = int.Parse(sWaferInfo.Substring(index, 1));
  1162. //合理的映射到内部支持的叠片/交叉片
  1163. if (waferState >= 7) waferState = 7;
  1164. else if (waferState >= 2) waferState = 3;
  1165. WaferStatus st = (WaferStatus)waferState;
  1166. if (st != WaferStatus.Empty)
  1167. {
  1168. WaferManager.Instance.CreateWafer(eArg.Module, index, st);
  1169. }
  1170. else
  1171. {
  1172. WaferManager.Instance.DeleteWafer(eArg.Module, index);
  1173. }
  1174. }
  1175. }
  1176. private void OnCommandUpdated(EfemMessage message)
  1177. {
  1178. try
  1179. {
  1180. switch (message.Operation)
  1181. {
  1182. case EfemOperation.ClearError:
  1183. case EfemOperation.Align:
  1184. case EfemOperation.Pick:
  1185. case EfemOperation.Place:
  1186. case EfemOperation.Extend:
  1187. case EfemOperation.Goto:
  1188. case EfemOperation.Orgsh:
  1189. case EfemOperation.EmsStop:
  1190. case EfemOperation.Abort:
  1191. case EfemOperation.Speed:
  1192. case EfemOperation.Vacuum:
  1193. case EfemOperation.PowerOn:
  1194. _status = RState.End;
  1195. break;
  1196. case EfemOperation.Map:
  1197. if (ModuleHelper.IsLoadPort(message.Module))
  1198. {
  1199. _LPMs[message.Module - ModuleName.LP1].OnMaped();
  1200. }
  1201. _status = RState.End;
  1202. break;
  1203. case EfemOperation.StateTrack:
  1204. {
  1205. string str = message.Data.Count >= 1 ? message.Data.First() : string.Empty;
  1206. if (str.ToLower() == "track")
  1207. {
  1208. string strA = message.Data.Count > 1 ? message.Data[1].ToString() : string.Empty;
  1209. if (strA.ToLower() != NONE.ToLower())
  1210. {
  1211. if (WaferManager.Instance.CheckNoWafer(ModuleName.EfemRobot, 0))
  1212. {
  1213. WaferManager.Instance.CreateWafer(ModuleName.EfemRobot, 0, WaferStatus.Normal);
  1214. }
  1215. }
  1216. string strB = message.Data.Count > 2 ? message.Data[2].ToString() : string.Empty;
  1217. if (strB.ToLower() != NONE.ToLower())
  1218. {
  1219. if (WaferManager.Instance.CheckNoWafer(ModuleName.EfemRobot, 1))
  1220. {
  1221. WaferManager.Instance.CreateWafer(ModuleName.EfemRobot, 1, WaferStatus.Normal);
  1222. }
  1223. }
  1224. }
  1225. _status = RState.End;
  1226. }
  1227. break;
  1228. case EfemOperation.Home:
  1229. {
  1230. if (_currentMsg.Module == ModuleName.EFEM)
  1231. {
  1232. _LPMs[0].OnHomed();
  1233. _LPMs[1].OnHomed();
  1234. _LPMs[2].OnHomed();
  1235. }
  1236. else if (ModuleHelper.IsLoadPort(_currentMsg.Module))
  1237. {
  1238. _LPMs[_currentMsg.Module - ModuleName.LP1].OnHomed();
  1239. }
  1240. _status = RState.End;
  1241. }
  1242. break;
  1243. case EfemOperation.Load:
  1244. {
  1245. _LPMs[message.Module - ModuleName.LP1].OnLoaded();
  1246. _status = RState.End;
  1247. }
  1248. break;
  1249. case EfemOperation.Unload:
  1250. {
  1251. _LPMs[message.Module - ModuleName.LP1].OnUnloaded();
  1252. _status = RState.End;
  1253. }
  1254. break;
  1255. case EfemOperation.CarrierId:
  1256. {
  1257. if (message.Head == EfemMessage.MsgHead.GET)
  1258. {
  1259. _LPMs[message.Module - ModuleName.LP1].OnCarrierIDRead(message.Data.First());
  1260. }
  1261. else
  1262. {
  1263. _LPMs[message.Module - ModuleName.LP1].OnCarrierIDWrite(message.Data.First());
  1264. }
  1265. _status = RState.End;
  1266. }
  1267. break;
  1268. case EfemOperation.Clamp:
  1269. {
  1270. _LPMs[message.Module - ModuleName.LP1].OnClamped(_bIsUnloadClamp);
  1271. _status = RState.End;
  1272. }
  1273. break;
  1274. case EfemOperation.Unclamp:
  1275. {
  1276. _LPMs[message.Module - ModuleName.LP1].OnUnclamped();
  1277. _status = RState.End;
  1278. }
  1279. break;
  1280. case EfemOperation.Dock:
  1281. {
  1282. _LPMs[message.Module - ModuleName.LP1].OnDocked();
  1283. _status = RState.End;
  1284. }
  1285. break;
  1286. case EfemOperation.Undock:
  1287. {
  1288. _LPMs[message.Module - ModuleName.LP1].OnUndocked();
  1289. _status = RState.End;
  1290. }
  1291. break;
  1292. case EfemOperation.Ready:
  1293. {
  1294. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.CommReady);
  1295. }
  1296. break;
  1297. case EfemOperation.Size:
  1298. {
  1299. if (message.Data.Count != 0)
  1300. {
  1301. if(ModuleHelper.IsLoadPort(message.Module))
  1302. {
  1303. string waferSize = message.Data[0];
  1304. if (waferSize == "200")
  1305. {
  1306. _LPMs[message.Module - ModuleName.LP1].UpdateWaferSize(WaferSize.WS8);
  1307. }
  1308. else if (waferSize == "300")
  1309. {
  1310. _LPMs[message.Module - ModuleName.LP1].UpdateWaferSize(WaferSize.WS12);
  1311. }
  1312. else
  1313. {
  1314. _LPMs[message.Module - ModuleName.LP1].UpdateWaferSize(WaferSize.WS0);
  1315. }
  1316. }
  1317. }
  1318. _status = RState.End;
  1319. }
  1320. break;
  1321. }
  1322. }
  1323. catch(Exception ex)
  1324. {
  1325. string error = $"OnCommandUpdated meets {ex.Message}";
  1326. LOG.WriteLog(eEvent.ERR_EFEM_COMMON_FAILED, Module.ToString(), error);
  1327. _status = RState.Failed;
  1328. Singleton<RouteManager>.Instance.EFEM.PostMsg(EfemEntity.MSG.Error,error);
  1329. }
  1330. }
  1331. async void SendBack(string data)
  1332. {
  1333. await Task.Run(() => _socket.Write(data + '\r'));
  1334. }
  1335. }
  1336. }