SimulatorSystem_R.cs 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681
  1. using Aitex.Core.RT.DataCenter;
  2. using Aitex.Core.RT.IOCore;
  3. using Aitex.Core.RT.Log;
  4. using Aitex.Core.Util;
  5. using MECF.Framework.Common.Equipment;
  6. using MECF.Framework.Simulator.Core.Driver;
  7. using System;
  8. using System.Collections.Generic;
  9. using VirgoSimulator.Devices;
  10. namespace VirgoSimulator.Instances
  11. {
  12. public class SimulatorSystem_R : Singleton<SimulatorSystem_R>
  13. {
  14. private PeriodicJob _thread;
  15. private Random _rd = new Random();
  16. private RD_TRIG _trigATM = new RD_TRIG();
  17. private RD_TRIG _trigVAC = new RD_TRIG();
  18. private readonly float ATM_THRESHOLD = 750000;
  19. private readonly float ATM_PRESSURE = 760000;
  20. private readonly uint VAC_SW_PRESSURE = 9500;
  21. private readonly uint PROCESS_GAUGE = 10000;
  22. private Dictionary<ModuleName, DeviceSimulator> _MockDevices = new Dictionary<ModuleName, DeviceSimulator>();
  23. public SimulatorSystem_R()
  24. {
  25. //_MockDevices.Add(ModuleName.PMB, new SkyPumpMock());
  26. //_MockDevices.Add(ModuleName.PMB, new AdTecGeneratorMock());
  27. //_MockDevices.Add(ModuleName.PMB, new AdTecMatchMock());
  28. // TODO
  29. }
  30. ~SimulatorSystem_R()
  31. {
  32. _thread?.Stop();
  33. }
  34. public void Initialize()
  35. {
  36. SetDefaultValue(ModuleName.PMA);
  37. SetDefaultValue(ModuleName.PMB);
  38. Singleton<DataManager>.Instance.Initialize(false);
  39. _thread = new PeriodicJob(500, OnMonitor, nameof(SimulatorSystem_R), true);
  40. }
  41. private void SetDefaultValue(ModuleName mod)
  42. {
  43. // chamber
  44. IO.DI[$"{mod}.DI_Lid_Closed"].Value = true;
  45. IO.DI[$"{mod}.DI_PM_ATM_SW"].Value = true;
  46. IO.DI[$"{mod}.DI_CDA_Pressure"].Value = true;
  47. IO.DI[$"{mod}.DI_Source_Fans_Running"].Value = true;
  48. //IO.DI[$"{mod}.DI_SourceFan2"].Value = true;
  49. IO.DI[$"{mod}.DI_Cooling_Water_Flow_SW"].Value = true;
  50. //IO.DI[$"{mod}.DI_Coolant_Inlet_TC_Broken_Alarm"].Value = false;
  51. //IO.DI[$"{mod}.DI_Coolant_Outlet_TC_Broken_Alarm"].Value = false;
  52. IO.DI[$"{mod}.DI_Water_Leak"].Value = true;
  53. IO.DI[$"{mod}.DI_ARM_Not_Extend_to_PM"].Value = true;
  54. IO.DI[$"{mod}.DI_Control_Box_Fans_Running"].Value = true;
  55. IO.DI[$"{mod}.DI_AC_RACK_Fans_Running"].Value = true;
  56. IO.DI[$"{mod}.DI_AC_RACK_Smoke_Detect_SW"].Value = true;
  57. IO.DI[$"{mod}.DI_AC_RACK_Main_Power_ON"].Value = true;
  58. IO.DI[$"{mod}.DI_MFC1_Pressure"].Value = true;
  59. IO.DI[$"{mod}.DI_MFC2_Pressure"].Value = true;
  60. IO.DI[$"{mod}.DI_MFC3_Pressure"].Value = true;
  61. IO.DI[$"{mod}.DI_MFC4_Pressure"].Value = true;
  62. IO.DI[$"{mod}.DI_MFC5_Pressure"].Value = true;
  63. IO.DI[$"{mod}.DI_EFEM_Side_Panel_Closed"].Value = true;
  64. //IO.DI[$"{mod}.DI_Generator_Hardware_Interlock"].Value = true;
  65. IO.DI[$"{mod}.DI_SRF_Match_Interlock_OK"].Value = true;
  66. IO.DI[$"{mod}.DI_BRF_Match_Interlock_OK"].Value = true;
  67. IO.DI[$"{mod}.DI_RF_Interlock_OK"].Value = true;
  68. IO.DI[$"{mod}.DI_N2_Pressure"].Value = true;
  69. // slit door
  70. IO.DI[$"{mod}.DI_Slit_Door_Open_Pos"].Value = false;
  71. IO.DI[$"{mod}.DI_Slit_Door_Close_Pos"].Value = true;
  72. //// lift pin
  73. //IO.DI[$"{mod}.DI_Lift_Pin_Up"].Value = false;
  74. //IO.DI[$"{mod}.DI_Lift_Pin_Down"].Value = true;
  75. //
  76. IO.DI[$"{mod}.DI_LE_OT_SW_Alarm"].Value = true;
  77. IO.DI[$"{mod}.DI_GB_Door_SW_Alarm"].Value = true;
  78. IO.DI[$"{mod}.DI_GB_Pressure_SW_Alarm"].Value = true;
  79. IO.DI[$"{mod}.DI_SRF_Match_Interlock_OK"].Value = true;
  80. IO.DI[$"{mod}.DI_BRF_Match_Interlock_OK"].Value = true;
  81. IO.DI[$"{mod}.DI_RF_Cover_Closed"].Value = true;
  82. IO.DI[$"{mod}.DI_CHBW_OT_SW"].Value = true;
  83. ////Guide pin
  84. //IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Up_Pos"].Value = false;
  85. //IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Down_Pos"].Value = true;
  86. //IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Up_Pos"].Value = false;
  87. //IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Down_Pos"].Value = true;
  88. //IO.DI[$"{mod}.DI_Dry_Pump_Running"].Value = false;
  89. //IO.DI[$"{mod}.DI_Pump_Remote_Status"].Value = true;
  90. //IO.DI[$"{mod}.DI_Pump_Alarm"].Value = false;
  91. // pressure
  92. SetAiValue($"{mod}.AI_Foreline_pressure", 5000);
  93. SetAiValue($"{mod}.AI_Chamber_pressure", ATM_PRESSURE);
  94. SetAiValue($"{mod}.AI_Process_pressure", PROCESS_GAUGE);
  95. ////SetAiValue($"{mod}.AI_Throttle_Valve_State", 1);
  96. //IO.AI[$"{mod}.AI_Throttle_Valve_State"].Value = 1;
  97. IO.AI[$"{mod}.AI_Throttle_Valve_Real_Position"].Value = 10;
  98. // Temperature
  99. SetAiValue($"{mod}.AI_Substrate_Control_TC_Temp", 28);
  100. SetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp", 27);
  101. SetAiValue($"{mod}.AI_Foreline_Control_TC_Temp", 28);
  102. SetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp", 27);
  103. SetAiValue($"{mod}.AI_Coolant_Inlet_Temp", 28);
  104. if (mod == ModuleName.PMA)
  105. {
  106. SetAiValue($"{mod}.AI_Coolant_Outlet_Temp", 29);
  107. }
  108. else if (mod == ModuleName.PMB)
  109. {
  110. SetAiValue($"{mod}.AI_Coolant_Outlet_Temp", 30);
  111. }
  112. // Datetime
  113. SetAiValue($"{mod}.AI_Year", DateTime.Today.Year);
  114. SetAiValue($"{mod}.AI_Month", DateTime.Today.Month);
  115. SetAiValue($"{mod}.AI_Day", DateTime.Today.Day);
  116. //IoTriStateLift
  117. IO.DI[$"{mod}.DI_Lift_Servo1_Alarm"].Value = true;
  118. IO.DI[$"{mod}.DI_Lift_Servo2_Alarm"].Value = true;
  119. IO.DI[$"{mod}.DI_Lift_Servo3_Alarm"].Value = true;
  120. IO.DI[$"{mod}.DI_Lift_Servo4_Alarm"].Value = true;
  121. IO.DI[$"{mod}.DI_Lift_Servo_ABS_fail_alarm"].Value = false;
  122. IO.DI[$"{mod}.DI_Lift_Servo_ORG_fail_alarm"].Value = false;
  123. IO.DI[$"{mod}.DI_Lift_Servo_ABS_fail_alarm"].Value = false;
  124. IO.DI[$"{mod}.DI_Lift_Servo_Over_software_Limit_alarm"].Value = false;
  125. IO.DI[$"{mod}.DI_MPE_CPU_Communication_Alarm"].Value = false;
  126. IO.DI[$"{mod}.DI_MPE_CPU_Battery_Alarm"].Value = false;
  127. IO.DI[$"{mod}.DI_MPE_CPU_OT_Warning"].Value = false;
  128. IO.DI[$"{mod}.DI_MPE_CPU_Error"].Value = false;
  129. }
  130. private bool OnMonitor()
  131. {
  132. try
  133. {
  134. // PMA
  135. MonitorSlitDoor(ModuleName.PMA);
  136. MonitorPin(ModuleName.PMA);
  137. MonitorPressure(ModuleName.PMA);
  138. MonitorTemperature(ModuleName.PMA);
  139. MonitorGas(ModuleName.PMA);
  140. ChangeTime(ModuleName.PMA);
  141. // PMB
  142. MonitorSlitDoor(ModuleName.PMB);
  143. MonitorPin(ModuleName.PMB);
  144. MonitorPressure(ModuleName.PMB);
  145. MonitorTemperature(ModuleName.PMB);
  146. MonitorGas(ModuleName.PMB);
  147. ChangeTime(ModuleName.PMB);
  148. }
  149. catch (Exception e)
  150. {
  151. LOG.Write(e);
  152. }
  153. return true;
  154. }
  155. private void ChangeTime(ModuleName mod)
  156. {
  157. // Heartbeat with PLC
  158. SetAiValue($"{mod}.AI_Heartbeat_FB", GetAoValue($"{mod}.AO_Heartbeat"));
  159. SetAiValue($"{mod}.AI_Time", DateTime.Now.Hour);
  160. SetAiValue($"{mod}.AI_Minute", DateTime.Now.Minute);
  161. SetAiValue($"{mod}.AI_Second", DateTime.Now.Second);
  162. }
  163. void MonitorSlitDoor(ModuleName mod)
  164. {
  165. // slit door open
  166. if (IO.DO[$"{mod}.DO_Slit_Door_Open"].Value)
  167. {
  168. IO.DI[$"{mod}.DI_Slit_Door_Open_Pos"].Value = true;
  169. IO.DI[$"{mod}.DI_Slit_Door_Close_Pos"].Value = false;
  170. }
  171. // slit door close
  172. if (IO.DO[$"{mod}.DO_Slit_Door_Close"].Value)
  173. {
  174. IO.DI[$"{mod}.DI_Slit_Door_Open_Pos"].Value = false;
  175. IO.DI[$"{mod}.DI_Slit_Door_Close_Pos"].Value = true;
  176. }
  177. }
  178. void MonitorPin(ModuleName mod)
  179. {
  180. //IoTriStateLift
  181. if (IO.DO[$"{mod}.DO_Lift_Servo_Go_Position1"].Value)
  182. {
  183. IO.DI[$"{mod}.DI_Lift_Servo_with_origin"].Value = false;
  184. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position1_Complete"].Value = true;
  185. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position2_Complete"].Value = false;
  186. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position3_Complete"].Value = false;
  187. }
  188. if (IO.DO[$"{mod}.DO_Lift_Servo_Go_Position2"].Value)
  189. {
  190. IO.DI[$"{mod}.DI_Lift_Servo_with_origin"].Value = false;
  191. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position1_Complete"].Value = false;
  192. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position2_Complete"].Value = true;
  193. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position3_Complete"].Value = false;
  194. }
  195. if (IO.DO[$"{mod}.DO_Lift_Servo_Go_Position3"].Value)
  196. {
  197. IO.DI[$"{mod}.DI_Lift_Servo_with_origin"].Value = false;
  198. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position1_Complete"].Value = false;
  199. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position2_Complete"].Value = false;
  200. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position3_Complete"].Value = true;
  201. }
  202. if (IO.DO[$"{mod}.DO_Lift_Servo_Origin"].Value)
  203. {
  204. IO.DI[$"{mod}.DI_Lift_Servo_with_origin"].Value = true;
  205. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position1_Complete"].Value = false;
  206. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position2_Complete"].Value = false;
  207. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position3_Complete"].Value = false;
  208. }
  209. if (IO.DO[$"{mod}.DO_Lift_Servo_Manual_UP"].Value)
  210. {
  211. SetRealFloat(IO.AI[$"{mod}.AI_Lift_Servo_Current_Position"], GetRealFloat(IO.AI[$"{mod}.AI_Lift_Servo_Current_Position"]) + 0.3f);
  212. }
  213. else if (IO.DO[$"{mod}.DO_Lift_Servo_Manual_DOWN"].Value)
  214. {
  215. SetRealFloat(IO.AI[$"{mod}.AI_Lift_Servo_Current_Position"], GetRealFloat(IO.AI[$"{mod}.AI_Lift_Servo_Current_Position"]) - 0.3f);
  216. }
  217. //// lift pin up
  218. //if (IO.DO[$"{mod}.DO_Lift_Pin_Up"].Value != IO.DO[$"{mod}.DO_Lift_Pin_Down"].Value)
  219. //{
  220. // IO.DI[$"{mod}.DI_Lift_Pin_Up"].Value = IO.DO[$"{mod}.DO_Lift_Pin_Up"].Value;
  221. // IO.DI[$"{mod}.DI_Lift_Pin_Down"].Value = IO.DO[$"{mod}.DO_Lift_Pin_Down"].Value;
  222. //}
  223. //// upper guide pin up
  224. //if (IO.DO[$"{mod}.DO_Guide_Pin_Small_Lifter_Up"].Value)
  225. //{
  226. // IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Up_Pos"].Value = true;
  227. // IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Down_Pos"].Value = false;
  228. //}
  229. //// upper guide pin down
  230. //if (IO.DO[$"{mod}.DO_Guide_Pin_Small_Lifter_Down"].Value)
  231. //{
  232. // IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Up_Pos"].Value = false;
  233. // IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Down_Pos"].Value = true;
  234. //}
  235. //// lower guide pin up
  236. //if (IO.DO[$"{mod}.DO_Guide_Pin_Medium_Lifter_Up"].Value)
  237. //{
  238. // IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Up_Pos"].Value = true;
  239. // IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Down_Pos"].Value = false;
  240. //}
  241. //// lower guide pin down
  242. //if (IO.DO[$"{mod}.DO_Guide_Pin_Medium_Lifter_Down"].Value)
  243. //{
  244. // IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Up_Pos"].Value = false;
  245. // IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Down_Pos"].Value = true;
  246. //}
  247. }
  248. protected void SetRealFloat(IOAccessor<short> accessor, float val)
  249. {
  250. byte[] val2 = BitConverter.GetBytes(val);
  251. accessor.Buffer[accessor.Index] = BitConverter.ToInt16(val2, 0);
  252. accessor.Buffer[accessor.Index + 1] = BitConverter.ToInt16(val2, 2);
  253. }
  254. protected float GetRealFloat(IOAccessor<short> accessor)
  255. {
  256. byte[] low = BitConverter.GetBytes(accessor.Buffer[accessor.Index]);
  257. byte[] high = BitConverter.GetBytes(accessor.Buffer[accessor.Index + 1]);
  258. float res = BitConverter.ToSingle(new[] { low[0], low[1], high[0], high[1] }, 0);
  259. return res;
  260. }
  261. void MonitorPressure(ModuleName mod)
  262. {
  263. // pressure
  264. string sAI_Foreline = "AI_Foreline_pressure";
  265. // Foreline
  266. if (SkyPumpMockPMA._simPumpStatus == SkyPumpMockPMA.SimPumpStatus.Open || EdwardsPumpMockPMA._simPumpStatus == EdwardsPumpMockPMA.SimEdwardsPumpStatus.Open)
  267. {
  268. SetAiValue($"{mod}.{sAI_Foreline}", GetAiValue($"{mod}.{sAI_Foreline}") - _rd.Next(500, 600));
  269. }
  270. else
  271. {
  272. SetAiValue($"{mod}.{sAI_Foreline}", GetAiValue($"{mod}.{sAI_Foreline}") + _rd.Next(500, 600));
  273. }
  274. // PLC 模拟量范围[0,4000], 电压[0, 10V], 压力[0, 760Torr]
  275. string sAI_ChamberPressure = "AI_Chamber_pressure";
  276. string sAI_ProcessPressure = "AI_Process_pressure";
  277. //float chamber_pressure = GetMockChamberPressure(mod);
  278. //float process_pressure = GetAiValue($"{mod}.AI_Process_pressure");
  279. // soft pump & fast pump
  280. DOAccessor fast_pump_vlv = IO.DO[$"{mod}.DO_Fast_Pumping_Valve"];
  281. DOAccessor soft_pump_vlv = IO.DO[$"{mod}.DO_Soft_Pumping_Valve"];
  282. if (fast_pump_vlv.Value || soft_pump_vlv.Value)
  283. {
  284. if (fast_pump_vlv.Value && soft_pump_vlv.Value)
  285. {
  286. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  287. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  288. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  289. {
  290. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - 30000);
  291. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  292. }
  293. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  294. {
  295. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  296. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1500);
  297. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1500);
  298. }
  299. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - _rd.Next(15000, 16000));
  300. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - _rd.Next(150, 160));
  301. }
  302. else if (fast_pump_vlv.Value)
  303. {
  304. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  305. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  306. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  307. {
  308. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - 25000);
  309. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  310. }
  311. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  312. {
  313. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  314. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1300);
  315. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1300);
  316. }
  317. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - _rd.Next(12000, 13000));
  318. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - _rd.Next(120, 130));
  319. }
  320. else if (soft_pump_vlv.Value)
  321. {
  322. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  323. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  324. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  325. {
  326. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - 22000);
  327. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  328. }
  329. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  330. {
  331. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  332. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1100);
  333. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1100);
  334. }
  335. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - _rd.Next(13000, 14000));
  336. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - _rd.Next(100, 110));
  337. }
  338. }
  339. // fast vent & purge
  340. DOAccessor vent_vlv = IO.DO[$"{mod}.DO_Chamber_vent_valve"];
  341. DOAccessor purge_vlv = IO.DO[$"{mod}.DO_Chamber_purge_valve"];
  342. if (vent_vlv.Value || purge_vlv.Value)
  343. {
  344. if (vent_vlv.Value && purge_vlv.Value)
  345. {
  346. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  347. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  348. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  349. {
  350. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + 30000);
  351. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  352. }
  353. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  354. {
  355. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  356. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 1500);
  357. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 1500);
  358. }
  359. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + _rd.Next(45000, 50000));
  360. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + _rd.Next(150, 160));
  361. }
  362. else if (vent_vlv.Value)
  363. {
  364. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  365. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  366. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  367. {
  368. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + 25000);
  369. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  370. }
  371. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  372. {
  373. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  374. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 1300);
  375. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 1300);
  376. }
  377. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + _rd.Next(25000, 30000));
  378. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + _rd.Next(130, 150));
  379. }
  380. else if (purge_vlv.Value)
  381. {
  382. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  383. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  384. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  385. {
  386. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + 30000);
  387. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  388. }
  389. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  390. {
  391. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  392. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 3100);
  393. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 3100);
  394. }
  395. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + _rd.Next(15000, 20000));
  396. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + _rd.Next(100, 120));
  397. }
  398. }
  399. // 压力值越界,复位
  400. float chamber_pressure1 = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  401. if (chamber_pressure1 > ATM_PRESSURE)
  402. {
  403. SetAiValue($"{mod}.AI_Chamber_pressure", ATM_PRESSURE);
  404. }
  405. else if (chamber_pressure1 < 20)
  406. {
  407. SetAiValue($"{mod}.AI_Chamber_pressure", 20);
  408. }
  409. float process_pressure1 = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  410. if (process_pressure1 > PROCESS_GAUGE)
  411. {
  412. SetAiValue($"{mod}.AI_Process_pressure", PROCESS_GAUGE);
  413. }
  414. else if (process_pressure1 < 20)
  415. {
  416. SetAiValue($"{mod}.AI_Process_pressure", 20);
  417. }
  418. float foreline_pressure = GetAiValue($"{mod}.{sAI_Foreline}");
  419. if (foreline_pressure > 10000)
  420. {
  421. SetAiValue($"{mod}.AI_Foreline_pressure", 10000);
  422. }
  423. else if (foreline_pressure < 150)
  424. {
  425. SetAiValue($"{mod}.AI_Foreline_pressure", 150);
  426. }
  427. // 模拟压力计漂移
  428. //int p1 = (int)GetMockChamberPressure(mod);
  429. //int new_p1 = _rd.Next(p1 - 2, p1 + 2);
  430. //SetAiValue($"{mod}.AI_Chamber_pressure", new_p1);
  431. //int p2 = (int)GetAiValue($"{mod}.AI_Foreline_pressure");
  432. //int new_p2 = _rd.Next(p2 - 1, p2 + 1);
  433. //SetAiValue($"{mod}.AI_Foreline_pressure", new_p2);
  434. //int p3 = (int)GetAiValue($"{mod}.AI_Process_pressure");
  435. //int new_p3 = _rd.Next(p3 - 1, p3 + 1);
  436. //SetAiValue($"{mod}.AI_Process_pressure", new_p3);
  437. // 根据当前压力值设定信号
  438. //float chamber_pressure2 = GetMockChamberPressure(mod);
  439. // ATM switch
  440. IO.DI[$"{mod}.DI_PM_ATM_SW"].Value = GetAiValue($"{mod}.{sAI_ChamberPressure}") > ATM_THRESHOLD;
  441. // VAC switch
  442. IO.DI[$"{mod}.DI_PM_VAC_SW"].Value = GetAiValue($"{mod}.{sAI_ChamberPressure}") < VAC_SW_PRESSURE;
  443. // Throttle valve
  444. //var pos_sp = IO.AO[$"{mod}.AO_Throttle_Valve_Pressure_Setpoint"].Value;
  445. //var mock_pos_fb = _rd.Next(pos_sp - 2, pos_sp + 2);
  446. ////IO.AI[$"{mod}.AI_Throttle_Valve_Real_Pressure"].Value = (short)mock_pos_fb;
  447. //SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", mock_pos_fb);
  448. // 压力值
  449. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") < GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"))
  450. {
  451. short increase = (short)_rd.Next(20, 30);
  452. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") + increase);
  453. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") > GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"))
  454. {
  455. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"));
  456. }
  457. }
  458. else
  459. {
  460. short increase = (short)_rd.Next(20, 30);
  461. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") - increase);
  462. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") < GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"))
  463. {
  464. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"));
  465. }
  466. }
  467. // 位置值
  468. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") < GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"))
  469. {
  470. short increase = (short)_rd.Next(20, 30);
  471. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Position", GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") + increase);
  472. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") > GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"))
  473. {
  474. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Position", GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"));
  475. }
  476. }
  477. else
  478. {
  479. short increase = (short)_rd.Next(20, 30);
  480. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Position", GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") - increase);
  481. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") < GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"))
  482. {
  483. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Position", GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"));
  484. }
  485. }
  486. }
  487. //float GetMockChamberPressure(ModuleName mod)
  488. //{
  489. // return GetAiValue($"{mod}.AI_Chamber_pressure");
  490. //}
  491. //void SetMockChamberPressure(ModuleName mod, float val)
  492. //{
  493. // SetAiValue($"{mod}.AI_Chamber_pressure", val);
  494. //}
  495. void SetAiValue(string name, float value)
  496. {
  497. byte[] flow = BitConverter.GetBytes(value);
  498. short high1 = BitConverter.ToInt16(flow, 0);
  499. short low1 = BitConverter.ToInt16(flow, 2);
  500. IO.AI[name].Buffer[IO.AI[name].Index] = BitConverter.ToInt16(flow, 0);
  501. IO.AI[name].Buffer[IO.AI[name].Index + 1] = BitConverter.ToInt16(flow, 2);
  502. byte[] high = BitConverter.GetBytes(IO.AI[name].Buffer[IO.AI[name].Index]);
  503. byte[] low = BitConverter.GetBytes(IO.AI[name].Buffer[IO.AI[name].Index + 1]);
  504. float readback = BitConverter.ToSingle(new[] { high[0], high[1], low[0], low[1] }, 0);
  505. }
  506. float GetAiValue(string name)
  507. {
  508. byte[] high = BitConverter.GetBytes(IO.AI[name].Buffer[IO.AI[name].Index]);
  509. byte[] low = BitConverter.GetBytes(IO.AI[name].Buffer[IO.AI[name].Index + 1]);
  510. float flow = BitConverter.ToSingle(new[] { high[0], high[1], low[0], low[1] }, 0);
  511. return flow;
  512. }
  513. float GetAoValue(string name)
  514. {
  515. byte[] high = BitConverter.GetBytes(IO.AO[name].Buffer[IO.AO[name].Index]);
  516. byte[] low = BitConverter.GetBytes(IO.AO[name].Buffer[IO.AO[name].Index + 1]);
  517. float flow = BitConverter.ToSingle(new[] { high[0], high[1], low[0], low[1] }, 0);
  518. return flow;
  519. }
  520. void MonitorTemperature(ModuleName mod)
  521. {
  522. IO.DI[$"{mod}.DI_Substrate_Heater_On_FB"].Value = IO.DO[$"{mod}.DO_Substrate_Heater_On"].Value;
  523. IO.DI[$"{mod}.DI_Foreline_Heater_On_FB"].Value = IO.DO[$"{mod}.DO_Forline_Heater_On"].Value;
  524. IO.DI[$"{mod}.DI_CHB_Wall_Heater_On_FB"].Value = IO.DO[$"{mod}.DO_CHB_Wall_Heater_On"].Value;
  525. IO.DI[$"{mod}.DI_Foreline_TC_Deviation_out_of_range"].Value = false;
  526. IO.DI[$"{mod}.DI_Substrate_TC_Deviation_out_of_range"].Value = false;
  527. // 底座
  528. if (IO.DO[$"{mod}.DO_Substrate_Heater_On"].Value &&
  529. GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") < GetAoValue($"{mod}.AO_Substrate_Temperature_Setpoint"))
  530. {
  531. SetAiValue($"{mod}.AI_Substrate_Control_TC_Temp", GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") + _rd.Next(1, 2));
  532. SetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp", GetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp") + _rd.Next(1, 2));
  533. }
  534. else if (IO.DO[$"{mod}.DO_Substrate_Heater_On"].Value &&
  535. GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") > GetAoValue($"{mod}.AO_Substrate_Temperature_Setpoint"))
  536. {
  537. SetAiValue($"{mod}.AI_Substrate_Control_TC_Temp", GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") - _rd.Next(1, 2));
  538. SetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp", GetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp") - _rd.Next(1, 2));
  539. }
  540. // Foreline
  541. if (IO.DO[$"{mod}.DO_Forline_Heater_On"].Value &&
  542. GetAiValue($"{mod}.AI_Foreline_Control_TC_Temp") < GetAoValue($"{mod}.AO_Foreline_Temperature_Setpoint"))
  543. {
  544. SetAiValue($"{mod}.AI_Foreline_Control_TC_Temp", GetAiValue($"{mod}.AI_Foreline_Control_TC_Temp") + _rd.Next(1, 2));
  545. SetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp", GetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp") + _rd.Next(1, 2));
  546. }
  547. else if (IO.DO[$"{mod}.DO_Forline_Heater_On"].Value &&
  548. GetAiValue($"{mod}.AI_Foreline_Control_TC_Temp") > GetAoValue($"{mod}.AO_Foreline_Temperature_Setpoint"))
  549. {
  550. SetAiValue($"{mod}.AI_Foreline_Control_TC_Temp", GetAiValue($"{mod}.AI_Foreline_Control_TC_Temp") - _rd.Next(1, 2));
  551. SetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp", GetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp") - _rd.Next(1, 2));
  552. }
  553. // Wall
  554. if (IO.DO[$"{mod}.DO_CHB_Wall_Heater_On"].Value &&
  555. GetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp") < GetAoValue($"{mod}.AO_CHB_Wall_Temperature_Setpoint"))
  556. {
  557. SetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp", GetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp") + _rd.Next(1, 2));
  558. SetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp", GetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp") + _rd.Next(1, 2));
  559. }
  560. else if (IO.DO[$"{mod}.DO_CHB_Wall_Heater_On"].Value &&
  561. GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") > GetAoValue($"{mod}.AO_CHB_Wall_Temperature_Setpoint"))
  562. {
  563. SetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp", GetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp") - _rd.Next(1, 2));
  564. SetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp", GetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp") - _rd.Next(1, 2));
  565. }
  566. }
  567. void MonitorGas(ModuleName mod)
  568. {
  569. // gas
  570. this.SimulateMFC(ModuleName.PMA, 1);
  571. this.SimulateMFC(ModuleName.PMA, 2);
  572. this.SimulateMFC(ModuleName.PMA, 3);
  573. this.SimulateMFC(ModuleName.PMA, 4);
  574. this.SimulateMFC(ModuleName.PMA, 5);
  575. this.SimulateMFC(ModuleName.PMB, 1);
  576. this.SimulateMFC(ModuleName.PMB, 2);
  577. this.SimulateMFC(ModuleName.PMB, 3);
  578. this.SimulateMFC(ModuleName.PMB, 4);
  579. this.SimulateMFC(ModuleName.PMB, 5);
  580. }
  581. private void SimulateMFC(ModuleName mod, byte gasNum)
  582. {
  583. var sp = GetAoValue($"{mod}.AO_MFC{gasNum}_Flow_Setpoint");
  584. if (gasNum == 3)
  585. {
  586. sp = Math.Max(0, sp - 1500);
  587. }
  588. var mock_fb = _rd.Next((int)sp - 3, (int)sp + 3) + _rd.NextDouble();
  589. SetAiValue($"{mod}.AI_MFC{gasNum}_Flow", (float)mock_fb);
  590. }
  591. public void Terminate()
  592. {
  593. _thread.Stop();
  594. }
  595. }
  596. }