SimulatorSystem.cs 36 KB

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