SimulatorSystem.cs 36 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716
  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 : Singleton<SimulatorSystem>
  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()
  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()
  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), 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_CDA_Pressure_Switch_Out_2"].Value = true;
  48. IO.DI[$"{mod}.DI_SourceFan1"].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_MFC1_Pressure"].Value = true;
  55. IO.DI[$"{mod}.DI_MFC2_Pressure"].Value = true;
  56. IO.DI[$"{mod}.DI_MFC3_Pressure"].Value = true;
  57. IO.DI[$"{mod}.DI_MFC4_Pressure"].Value = true;
  58. IO.DI[$"{mod}.DI_MFC5_Pressure"].Value = true;
  59. IO.DI[$"{mod}.DI_EFEM_Side_Panel_Closed"].Value = true;
  60. IO.DI[$"{mod}.DI_Generator_Hardware_Interlock"].Value = true;
  61. IO.DI[$"{mod}.DI_ACR_Smoke_Monitoring"].Value = true;
  62. IO.DI[$"{mod}.DI_ACR_Power_On"].Value = true;
  63. IO.DI[$"{mod}.DI_N2_Pressure"].Value = true;
  64. // slit door
  65. IO.DI[$"{mod}.DI_Slit_Door_Open_Pos"].Value = false;
  66. IO.DI[$"{mod}.DI_Slit_Door_Close_Pos"].Value = true;
  67. // lift pin
  68. IO.DI[$"{mod}.DI_Lift_Pin_Up"].Value = false;
  69. IO.DI[$"{mod}.DI_Lift_Pin_Down"].Value = true;
  70. //
  71. IO.DI[$"{mod}.DI_LE_OT_SW_Alarm"].Value = false;
  72. IO.DI[$"{mod}.DI_GB_Interlock_Alarm"].Value = false;
  73. //Guide pin
  74. IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Up_Pos"].Value = false;
  75. IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Down_Pos"].Value = true;
  76. IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Up_Pos"].Value = false;
  77. IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Down_Pos"].Value = true;
  78. // pressure
  79. SetAiValue($"{mod}.AI_Foreline_pressure", 5000);
  80. SetAiValue($"{mod}.AI_Chamber_pressure", ATM_PRESSURE);
  81. SetAiValue($"{mod}.AI_Process_pressure", PROCESS_GAUGE);
  82. //SetAiValue($"{mod}.AI_Throttle_Valve_State", 1);
  83. IO.AI[$"{mod}.AI_Throttle_Valve_State"].Value = 1;
  84. IO.AI[$"{mod}.AI_Throttle_Valve_Real_Position"].Value = 10;
  85. // Temperature
  86. SetAiValue($"{mod}.AI_Substrate_Control_TC_Temp", 28);
  87. SetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp", 27);
  88. SetAiValue($"{mod}.AI_Foreline_Control_TC_Temp", 28);
  89. SetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp", 27);
  90. SetAiValue($"{mod}.AI_Coolant_Inlet_Temp", 28);
  91. //SetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp", 28);
  92. //SetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp", 27);
  93. //SetAiValue($"{mod}.AI_Grid_TC_Temp", 28);
  94. if (mod == ModuleName.PMA)
  95. {
  96. SetAiValue($"{mod}.AI_Coolant_Outlet_Temp", 29);
  97. }
  98. else if (mod == ModuleName.PMB)
  99. {
  100. SetAiValue($"{mod}.AI_Coolant_Outlet_Temp", 30);
  101. }
  102. // Datetime
  103. SetAiValue($"{mod}.AI_Year", DateTime.Today.Year);
  104. SetAiValue($"{mod}.AI_Month", DateTime.Today.Month);
  105. SetAiValue($"{mod}.AI_Day", DateTime.Today.Day);
  106. }
  107. private bool OnMonitor()
  108. {
  109. try
  110. {
  111. // PMA
  112. MonitorSlitDoor(ModuleName.PMA);
  113. MonitorPin(ModuleName.PMA);
  114. MonitorPressure(ModuleName.PMA);
  115. MonitorTemperature(ModuleName.PMA);
  116. MonitorGas(ModuleName.PMA);
  117. MonitorRF(ModuleName.PMA);
  118. ChangeTime(ModuleName.PMA);
  119. // PMB
  120. MonitorSlitDoor(ModuleName.PMB);
  121. MonitorPin(ModuleName.PMB);
  122. MonitorPressure(ModuleName.PMB);
  123. MonitorTemperature(ModuleName.PMB);
  124. MonitorGas(ModuleName.PMB);
  125. MonitorRF(ModuleName.PMB);
  126. ChangeTime(ModuleName.PMB);
  127. }
  128. catch (Exception e)
  129. {
  130. LOG.Write(e);
  131. }
  132. return true;
  133. }
  134. private void ChangeTime(ModuleName mod)
  135. {
  136. // Heartbeat with PLC
  137. SetAiValue($"{mod}.AI_Heartbeat_FB", GetAoValue($"{mod}.AO_Heartbeat"));
  138. SetAiValue($"{mod}.AI_Time", DateTime.Now.Hour);
  139. SetAiValue($"{mod}.AI_Minute", DateTime.Now.Minute);
  140. SetAiValue($"{mod}.AI_Second", DateTime.Now.Second);
  141. }
  142. void MonitorSlitDoor(ModuleName mod)
  143. {
  144. // slit door open
  145. if (IO.DO[$"{mod}.DO_Slit_Door_Open"].Value)
  146. {
  147. IO.DI[$"{mod}.DI_Slit_Door_Open_Pos"].Value = true;
  148. IO.DI[$"{mod}.DI_Slit_Door_Close_Pos"].Value = false;
  149. }
  150. // slit door close
  151. if (IO.DO[$"{mod}.DO_Slit_Door_Close"].Value)
  152. {
  153. IO.DI[$"{mod}.DI_Slit_Door_Open_Pos"].Value = false;
  154. IO.DI[$"{mod}.DI_Slit_Door_Close_Pos"].Value = true;
  155. }
  156. }
  157. void MonitorPin(ModuleName mod)
  158. {
  159. // lift pin up
  160. if (IO.DO[$"{mod}.DO_Lift_Pin_Up"].Value != IO.DO[$"{mod}.DO_Lift_Pin_Down"].Value)
  161. {
  162. IO.DI[$"{mod}.DI_Lift_Pin_Up"].Value = IO.DO[$"{mod}.DO_Lift_Pin_Up"].Value;
  163. IO.DI[$"{mod}.DI_Lift_Pin_Down"].Value = IO.DO[$"{mod}.DO_Lift_Pin_Down"].Value;
  164. }
  165. // upper guide pin up
  166. if (IO.DO[$"{mod}.DO_Guide_Pin_Small_Lifter_Up"].Value)
  167. {
  168. IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Up_Pos"].Value = true;
  169. IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Down_Pos"].Value = false;
  170. }
  171. // upper guide pin down
  172. if (IO.DO[$"{mod}.DO_Guide_Pin_Small_Lifter_Down"].Value)
  173. {
  174. IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Up_Pos"].Value = false;
  175. IO.DI[$"{mod}.DI_Guide_Pin_Small_Lifter_Down_Pos"].Value = true;
  176. }
  177. // lower guide pin up
  178. if (IO.DO[$"{mod}.DO_Guide_Pin_Medium_Lifter_Up"].Value)
  179. {
  180. IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Up_Pos"].Value = true;
  181. IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Down_Pos"].Value = false;
  182. }
  183. // lower guide pin down
  184. if (IO.DO[$"{mod}.DO_Guide_Pin_Medium_Lifter_Down"].Value)
  185. {
  186. IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Up_Pos"].Value = false;
  187. IO.DI[$"{mod}.DI_Guide_Pin_Medium_Lifter_Down_Pos"].Value = true;
  188. }
  189. //IoTriStateLift
  190. IO.DI[$"{mod}.DI_Lift_Servo_ABS_fail_alarm"].Value = false;
  191. if (IO.DO[$"{mod}.DO_Lift_Servo_Go_Position1"].Value)
  192. {
  193. IO.DI[$"{mod}.DI_Lift_Servo_with_origin"].Value = false;
  194. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position1_Complete"].Value = true;
  195. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position2_Complete"].Value = false;
  196. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position3_Complete"].Value = false;
  197. }
  198. if (IO.DO[$"{mod}.DO_Lift_Servo_Go_Position2"].Value)
  199. {
  200. IO.DI[$"{mod}.DI_Lift_Servo_with_origin"].Value = false;
  201. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position1_Complete"].Value = false;
  202. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position2_Complete"].Value = true;
  203. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position3_Complete"].Value = false;
  204. }
  205. if (IO.DO[$"{mod}.DO_Lift_Servo_Go_Position3"].Value)
  206. {
  207. IO.DI[$"{mod}.DI_Lift_Servo_with_origin"].Value = false;
  208. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position1_Complete"].Value = false;
  209. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position2_Complete"].Value = false;
  210. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position3_Complete"].Value = true;
  211. }
  212. if (IO.DO[$"{mod}.DO_Lift_Servo_origin"].Value)
  213. {
  214. IO.DI[$"{mod}.DI_Lift_Servo_with_origin"].Value = true;
  215. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position1_Complete"].Value = false;
  216. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position2_Complete"].Value = false;
  217. IO.DI[$"{mod}.DI_Lift_Servo_Go_Position3_Complete"].Value = false;
  218. }
  219. if (IO.DO[$"{mod}.DO_Lift_Servo_manaul_UP"].Value)
  220. {
  221. _SetRealFloat(IO.AI[$"{mod}.AI_Lift_Servo_current_value"], _GetRealFloat(IO.AI[$"{mod}.AI_Lift_Servo_current_value"]) + 0.3f);
  222. }
  223. else if (IO.DO[$"{mod}.DO_Lift_Servo_manaul_DOWN"].Value)
  224. {
  225. _SetRealFloat(IO.AI[$"{mod}.AI_Lift_Servo_current_value"], _GetRealFloat(IO.AI[$"{mod}.AI_Lift_Servo_current_value"]) - 0.3f);
  226. }
  227. MonitorGroupServoPin(mod);
  228. }
  229. void MonitorGroupServoPin(ModuleName mod)
  230. {
  231. //IoTriStateLift
  232. IO.DI[$"{mod}.DI_YAS_Servo_Controler_COMM_Alarm"].Value = false;
  233. IO.DI[$"{mod}.DI_YAS_Servo_Controler_Battery_Low_Alarm"].Value = false;
  234. if (IO.DO[$"{mod}.DO_Lift_Servo_Group_Go_Position1"].Value)
  235. {
  236. IO.DI[$"{mod}.DI_Lift_Virtual_Servo_Origin_Complete"].Value = false;
  237. IO.DI[$"{mod}.DI_Lift_Servo_1_Servo_Origin_Complete"].Value = false;
  238. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_Origin_Complete"].Value = false;
  239. IO.DI[$"{mod}.DI_Lift_Servo_2_Servo_Origin_Complete"].Value = false;
  240. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_1_Complete"].Value = true;
  241. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_2_Complete"].Value = false;
  242. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_3_Complete"].Value = false;
  243. }
  244. if (IO.DO[$"{mod}.DO_Lift_Servo_Group_Go_Position2"].Value)
  245. {
  246. IO.DI[$"{mod}.DI_Lift_Virtual_Servo_Origin_Complete"].Value = false;
  247. IO.DI[$"{mod}.DI_Lift_Servo_1_Servo_Origin_Complete"].Value = false;
  248. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_Origin_Complete"].Value = false;
  249. IO.DI[$"{mod}.DI_Lift_Servo_2_Servo_Origin_Complete"].Value = false;
  250. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_1_Complete"].Value = false;
  251. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_2_Complete"].Value = true;
  252. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_3_Complete"].Value = false;
  253. }
  254. if (IO.DO[$"{mod}.DO_Lift_Servo_Group_Go_Position3"].Value)
  255. {
  256. IO.DI[$"{mod}.DI_Lift_Virtual_Servo_Origin_Complete"].Value = false;
  257. IO.DI[$"{mod}.DI_Lift_Servo_1_Servo_Origin_Complete"].Value = false;
  258. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_Origin_Complete"].Value = false;
  259. IO.DI[$"{mod}.DI_Lift_Servo_2_Servo_Origin_Complete"].Value = false;
  260. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_1_Complete"].Value = false;
  261. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_2_Complete"].Value = false;
  262. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_3_Complete"].Value = true;
  263. }
  264. if (IO.DO[$"{mod}.DO_Lift_Servo_Group_Origin"].Value)
  265. {
  266. IO.DI[$"{mod}.DI_Lift_Virtual_Servo_Origin_Complete"].Value = true;
  267. IO.DI[$"{mod}.DI_Lift_Servo_1_Servo_Origin_Complete"].Value = true;
  268. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_Origin_Complete"].Value = true;
  269. IO.DI[$"{mod}.DI_Lift_Servo_2_Servo_Origin_Complete"].Value = true;
  270. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_1_Complete"].Value = false;
  271. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_2_Complete"].Value = false;
  272. IO.DI[$"{mod}.DI_Lift_Servo_Group_Go_Pos_3_Complete"].Value = false;
  273. }
  274. if (IO.DO[$"{mod}.DO_Lift_Servo_Group_Manual_Up"].Value)
  275. {
  276. _SetRealFloat(IO.AI[$"{mod}.AI_Lift_Virtual_Servo_Current_Position"], _GetRealFloat(IO.AI[$"{mod}.AI_Lift_Virtual_Servo_Current_Position"]) + 0.3f);
  277. }
  278. else if (IO.DO[$"{mod}.DO_Lift_Servo_Group_Manual_Down"].Value)
  279. {
  280. _SetRealFloat(IO.AI[$"{mod}.AI_Lift_Virtual_Servo_Current_Position"], _GetRealFloat(IO.AI[$"{mod}.AI_Lift_Virtual_Servo_Current_Position"]) - 0.3f);
  281. }
  282. }
  283. void MonitorPressure(ModuleName mod)
  284. {
  285. // pressure
  286. string sAI_Foreline = "AI_Foreline_pressure";
  287. // Foreline
  288. if (SkyPumpMockPMA._simPumpStatus == SkyPumpMockPMA.SimPumpStatus.Open || EdwardsPumpMockPMA._simPumpStatus == EdwardsPumpMockPMA.SimEdwardsPumpStatus.Open)
  289. {
  290. SetAiValue($"{mod}.{sAI_Foreline}", GetAiValue($"{mod}.{sAI_Foreline}") - _rd.Next(500, 600));
  291. }
  292. else
  293. {
  294. SetAiValue($"{mod}.{sAI_Foreline}", GetAiValue($"{mod}.{sAI_Foreline}") + _rd.Next(500, 600));
  295. }
  296. // PLC 模拟量范围[0,4000], 电压[0, 10V], 压力[0, 760Torr]
  297. string sAI_ChamberPressure = "AI_Chamber_pressure";
  298. string sAI_ProcessPressure = "AI_Process_pressure";
  299. //float chamber_pressure = GetMockChamberPressure(mod);
  300. //float process_pressure = GetAiValue($"{mod}.AI_Process_pressure");
  301. // soft pump & fast pump
  302. DOAccessor fast_pump_vlv = IO.DO[$"{mod}.DO_Fast_Pumping_Valve"];
  303. DOAccessor soft_pump_vlv = IO.DO[$"{mod}.DO_Soft_Pumping_Valve"];
  304. if (fast_pump_vlv.Value || soft_pump_vlv.Value)
  305. {
  306. if (fast_pump_vlv.Value && soft_pump_vlv.Value)
  307. {
  308. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  309. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  310. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  311. {
  312. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - 30000);
  313. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  314. }
  315. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  316. {
  317. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  318. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1500);
  319. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1500);
  320. }
  321. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - _rd.Next(15000, 16000));
  322. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - _rd.Next(150, 160));
  323. }
  324. else if (fast_pump_vlv.Value)
  325. {
  326. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  327. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  328. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  329. {
  330. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - 25000);
  331. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  332. }
  333. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  334. {
  335. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  336. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1300);
  337. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1300);
  338. }
  339. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - _rd.Next(12000, 13000));
  340. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - _rd.Next(120, 130));
  341. }
  342. else if (soft_pump_vlv.Value)
  343. {
  344. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  345. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  346. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  347. {
  348. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - 22000);
  349. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  350. }
  351. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  352. {
  353. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  354. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1100);
  355. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 1100);
  356. }
  357. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") - _rd.Next(13000, 14000));
  358. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - _rd.Next(100, 110));
  359. }
  360. }
  361. // fast vent & purge
  362. DOAccessor vent_vlv = IO.DO[$"{mod}.DO_Chamber_vent_valve"];
  363. DOAccessor purge_vlv = IO.DO[$"{mod}.DO_Chamber_purge_valve"];
  364. if (vent_vlv.Value || purge_vlv.Value)
  365. {
  366. if (vent_vlv.Value && purge_vlv.Value)
  367. {
  368. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  369. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  370. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  371. {
  372. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + 30000);
  373. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  374. }
  375. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  376. {
  377. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  378. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 1500);
  379. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 1500);
  380. }
  381. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + _rd.Next(45000, 50000));
  382. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + _rd.Next(150, 160));
  383. }
  384. else if (vent_vlv.Value)
  385. {
  386. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  387. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  388. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  389. {
  390. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + 25000);
  391. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  392. }
  393. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  394. {
  395. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  396. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 1300);
  397. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 1300);
  398. }
  399. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + _rd.Next(25000, 30000));
  400. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + _rd.Next(130, 150));
  401. }
  402. else if (purge_vlv.Value)
  403. {
  404. float getAiValue_ChamberPressure = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  405. float getAiValue_ProcessPressure = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  406. if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure > 10000)
  407. {
  408. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + 30000);
  409. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") - 150);
  410. }
  411. else if (getAiValue_ProcessPressure <= 10000 && getAiValue_ChamberPressure <= 10000)
  412. {
  413. getAiValue_ProcessPressure = getAiValue_ChamberPressure;
  414. SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 3100);
  415. SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + 3100);
  416. }
  417. //SetAiValue($"{mod}.{sAI_ChamberPressure}", GetAiValue($"{mod}.{sAI_ChamberPressure}") + _rd.Next(15000, 20000));
  418. //SetAiValue($"{mod}.{sAI_ProcessPressure}", GetAiValue($"{mod}.{sAI_ProcessPressure}") + _rd.Next(100, 120));
  419. }
  420. }
  421. // 压力值越界,复位
  422. float chamber_pressure1 = GetAiValue($"{mod}.{sAI_ChamberPressure}");
  423. if (chamber_pressure1 > ATM_PRESSURE)
  424. {
  425. SetAiValue($"{mod}.AI_Chamber_pressure", ATM_PRESSURE);
  426. }
  427. else if (chamber_pressure1 < 20)
  428. {
  429. SetAiValue($"{mod}.AI_Chamber_pressure", 20);
  430. }
  431. float process_pressure1 = GetAiValue($"{mod}.{sAI_ProcessPressure}");
  432. if (process_pressure1 > PROCESS_GAUGE)
  433. {
  434. SetAiValue($"{mod}.AI_Process_pressure", PROCESS_GAUGE);
  435. }
  436. else if (process_pressure1 < 20)
  437. {
  438. SetAiValue($"{mod}.AI_Process_pressure", 20);
  439. }
  440. float foreline_pressure = GetAiValue($"{mod}.{sAI_Foreline}");
  441. if (foreline_pressure > 10000)
  442. {
  443. SetAiValue($"{mod}.AI_Foreline_pressure", 10000);
  444. }
  445. else if (foreline_pressure < 150)
  446. {
  447. SetAiValue($"{mod}.AI_Foreline_pressure", 150);
  448. }
  449. // 模拟压力计漂移
  450. //int p1 = (int)GetMockChamberPressure(mod);
  451. //int new_p1 = _rd.Next(p1 - 2, p1 + 2);
  452. //SetAiValue($"{mod}.AI_Chamber_pressure", new_p1);
  453. //int p2 = (int)GetAiValue($"{mod}.AI_Foreline_pressure");
  454. //int new_p2 = _rd.Next(p2 - 1, p2 + 1);
  455. //SetAiValue($"{mod}.AI_Foreline_pressure", new_p2);
  456. //int p3 = (int)GetAiValue($"{mod}.AI_Process_pressure");
  457. //int new_p3 = _rd.Next(p3 - 1, p3 + 1);
  458. //SetAiValue($"{mod}.AI_Process_pressure", new_p3);
  459. // 根据当前压力值设定信号
  460. //float chamber_pressure2 = GetMockChamberPressure(mod);
  461. // ATM switch
  462. IO.DI[$"{mod}.DI_PM_ATM_SW"].Value = GetAiValue($"{mod}.{sAI_ChamberPressure}") > ATM_THRESHOLD;
  463. // VAC switch
  464. IO.DI[$"{mod}.DI_PM_VAC_SW"].Value = GetAiValue($"{mod}.{sAI_ChamberPressure}") < VAC_SW_PRESSURE;
  465. // Throttle valve
  466. //var pos_sp = IO.AO[$"{mod}.AO_Throttle_Valve_Pressure_Setpoint"].Value;
  467. //var mock_pos_fb = _rd.Next(pos_sp - 2, pos_sp + 2);
  468. ////IO.AI[$"{mod}.AI_Throttle_Valve_Real_Pressure"].Value = (short)mock_pos_fb;
  469. //SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", mock_pos_fb);
  470. // 压力值
  471. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") < GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"))
  472. {
  473. short increase = (short)_rd.Next(20, 30);
  474. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") + increase);
  475. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") > GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"))
  476. {
  477. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"));
  478. }
  479. }
  480. else
  481. {
  482. short increase = (short)_rd.Next(20, 30);
  483. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") - increase);
  484. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure") < GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"))
  485. {
  486. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Pressure", GetAoValue($"{mod}.AO_Throttle_Valve_Pressure_Setpoint"));
  487. }
  488. }
  489. // 位置值
  490. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") < GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"))
  491. {
  492. short increase = (short)_rd.Next(20, 30);
  493. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Position", GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") + increase);
  494. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") > GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"))
  495. {
  496. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Position", GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"));
  497. }
  498. }
  499. else
  500. {
  501. short increase = (short)_rd.Next(20, 30);
  502. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Position", GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") - increase);
  503. if (GetAiValue($"{mod}.AI_Throttle_Valve_Real_Position") < GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"))
  504. {
  505. SetAiValue($"{mod}.AI_Throttle_Valve_Real_Position", GetAoValue($"{mod}.AO_Throttle_Valve_Position_Setpoint"));
  506. }
  507. }
  508. }
  509. //float GetMockChamberPressure(ModuleName mod)
  510. //{
  511. // return GetAiValue($"{mod}.AI_Chamber_pressure");
  512. //}
  513. //void SetMockChamberPressure(ModuleName mod, float val)
  514. //{
  515. // SetAiValue($"{mod}.AI_Chamber_pressure", val);
  516. //}
  517. void SetAiValue(string name, float value)
  518. {
  519. byte[] flow = BitConverter.GetBytes(value);
  520. short high1 = BitConverter.ToInt16(flow, 0);
  521. short low1 = BitConverter.ToInt16(flow, 2);
  522. IO.AI[name].Buffer[IO.AI[name].Index] = BitConverter.ToInt16(flow, 0);
  523. IO.AI[name].Buffer[IO.AI[name].Index + 1] = BitConverter.ToInt16(flow, 2);
  524. byte[] high = BitConverter.GetBytes(IO.AI[name].Buffer[IO.AI[name].Index]);
  525. byte[] low = BitConverter.GetBytes(IO.AI[name].Buffer[IO.AI[name].Index + 1]);
  526. float readback = BitConverter.ToSingle(new[] { high[0], high[1], low[0], low[1] }, 0);
  527. }
  528. float GetAiValue(string name)
  529. {
  530. byte[] high = BitConverter.GetBytes(IO.AI[name].Buffer[IO.AI[name].Index]);
  531. byte[] low = BitConverter.GetBytes(IO.AI[name].Buffer[IO.AI[name].Index + 1]);
  532. float flow = BitConverter.ToSingle(new[] { high[0], high[1], low[0], low[1] }, 0);
  533. return flow;
  534. }
  535. float GetAoValue(string name)
  536. {
  537. byte[] high = BitConverter.GetBytes(IO.AO[name].Buffer[IO.AO[name].Index]);
  538. byte[] low = BitConverter.GetBytes(IO.AO[name].Buffer[IO.AO[name].Index + 1]);
  539. float flow = BitConverter.ToSingle(new[] { high[0], high[1], low[0], low[1] }, 0);
  540. return flow;
  541. }
  542. protected float _GetRealFloat(IOAccessor<short> accessor)
  543. {
  544. byte[] low = BitConverter.GetBytes(accessor.Buffer[accessor.Index]);
  545. byte[] high = BitConverter.GetBytes(accessor.Buffer[accessor.Index + 1]);
  546. float res = BitConverter.ToSingle(new[] { low[0], low[1], high[0], high[1] }, 0);
  547. return res;
  548. }
  549. protected void _SetRealFloat(IOAccessor<short> accessor, float val)
  550. {
  551. byte[] val2 = BitConverter.GetBytes(val);
  552. accessor.Buffer[accessor.Index] = BitConverter.ToInt16(val2, 0);
  553. accessor.Buffer[accessor.Index + 1] = BitConverter.ToInt16(val2, 2);
  554. }
  555. void MonitorTemperature(ModuleName mod)
  556. {
  557. IO.DI[$"{mod}.DI_Substrate_Heater_On_FB"].Value = IO.DO[$"{mod}.DO_Substrate_Heater_On"].Value;
  558. IO.DI[$"{mod}.DI_Foreline_Heater_On_FB"].Value = IO.DO[$"{mod}.DO_Forline_Heater_On"].Value;
  559. //IO.DI[$"{mod}.DI_CHB_Wall_Heater_On_FB"].Value = IO.DO[$"{mod}.DO_CHB_Wall_Heater_On"].Value;
  560. IO.DI[$"{mod}.DI_Foreline_TC_Deviation_out_of_range"].Value = false;
  561. IO.DI[$"{mod}.DI_Substrate_TC_Deviation_out_of_range"].Value = false;
  562. // 底座
  563. if (IO.DO[$"{mod}.DO_Substrate_Heater_On"].Value &&
  564. GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") < GetAoValue($"{mod}.AO_Substrate_Temperature_Setpoint"))
  565. {
  566. SetAiValue($"{mod}.AI_Substrate_Control_TC_Temp", GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") + _rd.Next(1, 2));
  567. SetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp", GetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp") + _rd.Next(1, 2));
  568. }
  569. else if (IO.DO[$"{mod}.DO_Substrate_Heater_On"].Value &&
  570. GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") > GetAoValue($"{mod}.AO_Substrate_Temperature_Setpoint"))
  571. {
  572. SetAiValue($"{mod}.AI_Substrate_Control_TC_Temp", GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") - _rd.Next(1, 2));
  573. SetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp", GetAiValue($"{mod}.AI_Substrate_Monitor_TC_Temp") - _rd.Next(1, 2));
  574. }
  575. // Foreline
  576. if (IO.DO[$"{mod}.DO_Forline_Heater_On"].Value &&
  577. GetAiValue($"{mod}.AI_Foreline_Control_TC_Temp") < GetAoValue($"{mod}.AO_Foreline_Temperature_Setpoint"))
  578. {
  579. SetAiValue($"{mod}.AI_Foreline_Control_TC_Temp", GetAiValue($"{mod}.AI_Foreline_Control_TC_Temp") + _rd.Next(1, 2));
  580. SetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp", GetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp") + _rd.Next(1, 2));
  581. }
  582. else if (IO.DO[$"{mod}.DO_Forline_Heater_On"].Value &&
  583. GetAiValue($"{mod}.AI_Foreline_Control_TC_Temp") > GetAoValue($"{mod}.AO_Foreline_Temperature_Setpoint"))
  584. {
  585. SetAiValue($"{mod}.AI_Foreline_Control_TC_Temp", GetAiValue($"{mod}.AI_Foreline_Control_TC_Temp") - _rd.Next(1, 2));
  586. SetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp", GetAiValue($"{mod}.AI_Foreline_Monitor_TC_Temp") - _rd.Next(1, 2));
  587. }
  588. // Wall
  589. //if (IO.DO[$"{mod}.DO_CHB_Wall_Heater_On"].Value &&
  590. // GetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp") < GetAoValue($"{mod}.AO_CHB_Wall_Temperature_Setpoint"))
  591. //{
  592. // SetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp", GetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp") + _rd.Next(1, 2));
  593. // SetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp", GetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp") + _rd.Next(1, 2));
  594. //}
  595. //else if (IO.DO[$"{mod}.DO_CHB_Wall_Heater_On"].Value &&
  596. // GetAiValue($"{mod}.AI_Substrate_Control_TC_Temp") > GetAoValue($"{mod}.AO_CHB_Wall_Temperature_Setpoint"))
  597. //{
  598. // SetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp", GetAiValue($"{mod}.AI_CHB_Wall_Control_TC_Temp") - _rd.Next(1, 2));
  599. // SetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp", GetAiValue($"{mod}.AI_CHB_Wall_Monitor_TC_Temp") - _rd.Next(1, 2));
  600. //}
  601. }
  602. void MonitorGas(ModuleName mod)
  603. {
  604. // gas
  605. this.SimulateMFC(ModuleName.PMA, 1);
  606. this.SimulateMFC(ModuleName.PMA, 2);
  607. this.SimulateMFC(ModuleName.PMA, 3);
  608. this.SimulateMFC(ModuleName.PMA, 4);
  609. this.SimulateMFC(ModuleName.PMA, 5);
  610. this.SimulateMFC(ModuleName.PMB, 1);
  611. this.SimulateMFC(ModuleName.PMB, 2);
  612. this.SimulateMFC(ModuleName.PMB, 3);
  613. this.SimulateMFC(ModuleName.PMB, 4);
  614. this.SimulateMFC(ModuleName.PMB, 5);
  615. }
  616. private void SimulateMFC(ModuleName mod, byte gasNum)
  617. {
  618. var sp = GetAoValue($"{mod}.AO_MFC{gasNum}_Flow_Setpoint");
  619. var mock_fb = _rd.Next((int)sp - 3, (int)sp + 3) + _rd.NextDouble();
  620. SetAiValue($"{mod}.AI_MFC{gasNum}_Flow", (float)mock_fb);
  621. }
  622. void MonitorRF(ModuleName mod)
  623. {
  624. // RF generator
  625. var sp = GetAoValue($"{mod}.AO_Generator_Power_Setpoint");
  626. var mock_fb = _rd.Next((int)sp - 3, (int)sp + 3) + _rd.NextDouble();
  627. //var mock_sp = _rd.Next(sp - 3, sp + 3);
  628. SetAiValue($"{mod}.AI_Generator_Forward_Power", (float)mock_fb);
  629. //IO.DI[$"{mod}.DI_Generator_Power_Status"].Value = IO.DO[$"{mod}.DO_Generator_Power_ON"].Value;
  630. }
  631. public void Terminate()
  632. {
  633. _thread.Stop();
  634. }
  635. }
  636. }