WagoSocketSimulator.cs 46 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957
  1. using Aitex.Common.Util;
  2. using Aitex.Core.RT.Device;
  3. using Aitex.Core.RT.Log;
  4. using Aitex.Core.UI.Control;
  5. using Aitex.Core.Util;
  6. using MECF.Framework.Common.Device.Festo;
  7. using MECF.Framework.Common.Device.Wago;
  8. using MECF.Framework.Common.Net;
  9. using MECF.Framework.Common.Simulator;
  10. using MECF.Framework.Simulator.Core.Driver;
  11. using System;
  12. using System.Collections.Generic;
  13. using System.IO;
  14. using static MECF.Framework.Common.Simulator.MotorSimulator;
  15. namespace CyberX8_Simulator.Devices
  16. {
  17. public class WagoSocketSimulator : SocketDeviceSimulator
  18. {
  19. private const short WRITE_DO_STARTADDRESS = 0x0200;
  20. private const short WRITE_AO_STARTADDRESS = 0x0200;
  21. //键是名字,值是对应数据所在的位置 注意:要和WagoControlCfg里面的地址顺序对上
  22. public Dictionary<string, int> DONameIndexDic;
  23. public Dictionary<string, int> DINameIndexDic;
  24. public Dictionary<string, int> AINameIndexDic;
  25. public Dictionary<string, int> AONameIndexDic;
  26. private IByteTransform byteTransform = new BigEndianByteTransformBase();
  27. //存储模拟器数据的数组
  28. public byte[] DOBytes = new byte[200];
  29. public short[] AOShorts = new short[200];
  30. public byte[] DIBytes = new byte[200];
  31. public short[] AIShorts = new short[200];
  32. /// <summary>
  33. /// 写DO锁
  34. /// </summary>
  35. private object _writeDOLocker = new object();
  36. /// <summary>
  37. /// 写AO锁
  38. /// </summary>
  39. private object _writeAOLocker = new object();
  40. /// <summary>
  41. /// Festo Data Buffer
  42. /// </summary>
  43. private Dictionary<string, bool> _festoDataBuffer = new Dictionary<string, bool>();
  44. /// <summary>
  45. /// Name-WagoDO dictionary
  46. /// </summary>
  47. private Dictionary<string, WagoDO> _doNameWagoDODic = new Dictionary<string, WagoDO>();
  48. /// <summary>
  49. /// Name-WagoDI dictionary
  50. /// </summary>
  51. private Dictionary<string, WagoDI> _diNameWagoDIDic = new Dictionary<string, WagoDI>();
  52. /// <summary>
  53. /// 定时器
  54. /// </summary>
  55. private PeriodicJob _LoaderPeriodicJob;
  56. private PeriodicJob _Wago2PeriodicJob;
  57. private PeriodicJob _Wago4PeriodicJob;
  58. private bool _rinse1FillValve = false;
  59. private bool _rinse1DumpValve = false;
  60. private bool _rinse2FillValve = false;
  61. private bool _rinse2DumpValve = false;
  62. private bool _rinse3FillValve = false;
  63. private bool _rinse3DumpValve = false;
  64. private bool _rinse4FillValve = false;
  65. private bool _rinse4DumpValve = false;
  66. private bool _reservoir1PumpOn = false;
  67. private int _srd1currentVacuumValue;
  68. private int _srd2currentVacuumValue;
  69. private int _port;
  70. //delegate
  71. #region Delegate
  72. public delegate void VariableValueChanged(object obj);
  73. public delegate void UpdateVariableValueWagoDatasChanged(string sourceName, string targetName, bool value,bool invert);
  74. #endregion
  75. #region 事件
  76. /// <summary>
  77. /// 变量变更事件
  78. /// </summary>
  79. public event VariableValueChanged OnDIVariableValueChanged;
  80. public event VariableValueChanged OnAIVariableValueChanged;
  81. public event VariableValueChanged OnDOVariableValueChanged;
  82. public event VariableValueChanged OnAOVariableValueChanged;
  83. #endregion
  84. public WagoSocketSimulator(int port):base(port)
  85. {
  86. SimulatorCommManager.Instance.OnUpdateVariableValueChanged += UpdataDataCausedByOtherModule;
  87. MotorSimulator.Instance.OnUpdateWagoDatasChanged += UpdataDataCausedByOtherModule;
  88. InitializeData(port);
  89. _port = port;
  90. }
  91. private void UpdataDataCausedByOtherModule(string sourceName,string name, bool value, bool invert)
  92. {
  93. value = invert ? !value : value;
  94. //AI Data
  95. if (AINameIndexDic.ContainsKey(name))
  96. {
  97. switch (name)
  98. {
  99. case "r_LoaderA_LS_Vacuum_anlg":
  100. case "r_LoaderB_LS_Vacuum_anlg":
  101. AIShorts[AINameIndexDic[name]] = value ? (short)0x32C8 : (short)0x2AF8;
  102. break;
  103. case "r_DPUF_A_CHUCK_A_VAC":
  104. case "r_DPUF_A_CHUCK_B_VAC":
  105. AIShorts[AINameIndexDic[name]] = value ? (short)0x0C80 : (short)0x32C8;
  106. break;
  107. case "r_LOADERA_BERNOULLI_PRESSURE":
  108. case "r_LOADERB_BERNOULLI_PRESSURE":
  109. case "r_LOADERA_CHUCK_BLADDER":
  110. case "r_LOADERB_CHUCK_BLADDER":
  111. case "r_LOADERA_WS_BLADDER_PRESSURE":
  112. case "r_LOADERB_WS_BLADDER_PRESSURE":
  113. AIShorts[AINameIndexDic[name]] = value ? (short)0x2AF8 : (short)0x00;
  114. break;
  115. case "r_PREWET_DI_PRESS":
  116. AIShorts[AINameIndexDic[name]] = value ? (short)15000 : (short)3276;
  117. AIShorts[AINameIndexDic["r_PREWET_FLOW"]] = value ? (short)25000 : (short)3276;
  118. break;
  119. default:
  120. break;
  121. }
  122. }
  123. if (!string.IsNullOrEmpty(sourceName))
  124. {
  125. switch (sourceName)
  126. {
  127. case "c_QDRD1_DI_FILL":
  128. _rinse1FillValve = value;
  129. break;
  130. case "c_QDRD1_DUMP":
  131. _rinse1DumpValve = value;
  132. break;
  133. case "c_QDRD2_DI_FILL":
  134. _rinse2FillValve = value;
  135. break;
  136. case "c_QDRD2_DUMP":
  137. _rinse2DumpValve = value;
  138. break;
  139. case "c_QDRD3_DI_FILL":
  140. _rinse3FillValve = value;
  141. break;
  142. case "c_QDRD3_DUMP":
  143. _rinse3DumpValve = value;
  144. break;
  145. case "c_QDRD4_DI_FILL":
  146. _rinse4FillValve = value;
  147. break;
  148. case "c_QDRD4_DUMP":
  149. _rinse4DumpValve = value;
  150. break;
  151. case "c_RESERVOIR1_PUMP_ON":
  152. _reservoir1PumpOn = value;
  153. break;
  154. default:
  155. break;
  156. }
  157. }
  158. //DI Data
  159. UpdataDIBytes(name, value ? 1 : 0);
  160. //Festo Data
  161. if (name == "FlowTestClamp")
  162. {
  163. _festoDataBuffer[name] = value;
  164. };
  165. }
  166. /// <summary>
  167. /// 触发Wago对应数据更新
  168. /// </summary>
  169. /// <param name="position"></param>
  170. /// <param name="value"></param>
  171. private void UpdateDataCausedByWago(int position, bool value)
  172. {
  173. //Puf Simulator
  174. if (DONameIndexDic.ContainsKey("c_PUF_CHUCK") && position == DONameIndexDic["c_PUF_CHUCK"])
  175. {
  176. value = _doNameWagoDODic["c_PUF_CHUCK"].Invert? !value : value;
  177. UpdataDIBytes("r_PUF_A_CHUCK_OUT", value ? 1 : 0);
  178. UpdataDIBytes("r_PUF_B_CHUCK_OUT", value ? 1 : 0);
  179. UpdataDIBytes("r_PUF_A_CHUCK_IN", !value ? 1 : 0);
  180. UpdataDIBytes("r_PUF_B_CHUCK_IN", !value ? 1 : 0);
  181. }
  182. //HVD Simulator
  183. if (DONameIndexDic.ContainsKey("c_HVD_1_HIGH") && position == DONameIndexDic["c_HVD_1_HIGH"])
  184. {
  185. value = _doNameWagoDODic["c_HVD_1_HIGH"].Invert ? !value : value;
  186. UpdataAIShorts("r_HVD_1_ANALOG", value ? 8000 : 0);
  187. }
  188. if (DONameIndexDic.ContainsKey("c_HVD_2_HIGH") && position == DONameIndexDic["c_HVD_2_HIGH"])
  189. {
  190. value = _doNameWagoDODic["c_HVD_2_HIGH"].Invert ? !value : value;
  191. UpdataAIShorts("r_HVD_2_ANALOG", value ? 8000 : 0);
  192. }
  193. //SRD Simulator
  194. //Lift UP
  195. if (DONameIndexDic.ContainsKey("c_SRD1_LIFT_UP") && position == DONameIndexDic["c_SRD1_LIFT_UP"])
  196. {
  197. value = (_doNameWagoDODic["c_SRD1_LIFT_UP"].Invert ^ _diNameWagoDIDic["r_SRD1_LIFT_UP"].Invert) ? !value : value;
  198. UpdataDIBytes("r_SRD1_LIFT_UP", value ? 1 : 0);
  199. }
  200. if (DONameIndexDic.ContainsKey("c_SRD2_LIFT_UP") && position == DONameIndexDic["c_SRD2_LIFT_UP"])
  201. {
  202. value = (_doNameWagoDODic["c_SRD2_LIFT_UP"].Invert ^ _diNameWagoDIDic["r_SRD2_LIFT_UP"].Invert) ? !value : value;
  203. UpdataDIBytes("r_SRD2_LIFT_UP", value ? 1 : 0);
  204. }
  205. //Flippers
  206. if (DONameIndexDic.ContainsKey("c_SRD1_150_FLIPPERS_IN") && position == DONameIndexDic["c_SRD1_150_FLIPPERS_IN"])
  207. {
  208. value = (_doNameWagoDODic["c_SRD1_150_FLIPPERS_IN"].Invert ^ _diNameWagoDIDic["r_SRD1_150_FLIPPER1_OUT"].Invert) ? !value : value;
  209. UpdataDIBytes("r_SRD1_150_FLIPPER1_OUT", value ? 0 : 1);
  210. UpdataDIBytes("r_SRD1_150_FLIPPER2_OUT", value ? 0 : 1);
  211. UpdataDIBytes("r_SRD1_150_FLIPPER3_OUT", value ? 0 : 1);
  212. }
  213. if (DONameIndexDic.ContainsKey("c_SRD2_150_FLIPPERS_IN") && position == DONameIndexDic["c_SRD2_150_FLIPPERS_IN"])
  214. {
  215. value = (_doNameWagoDODic["c_SRD2_150_FLIPPERS_IN"].Invert ^ _diNameWagoDIDic["r_SRD2_150_FLIPPER1_OUT"].Invert) ? !value : value;
  216. UpdataDIBytes("r_SRD2_150_FLIPPER1_OUT", value ? 0 : 1);
  217. UpdataDIBytes("r_SRD2_150_FLIPPER2_OUT", value ? 0 : 1);
  218. UpdataDIBytes("r_SRD2_150_FLIPPER3_OUT", value ? 0 : 1);
  219. }
  220. if (DONameIndexDic.ContainsKey("c_SRD1_200_FLIPPERS_IN") && position == DONameIndexDic["c_SRD1_200_FLIPPERS_IN"])
  221. {
  222. value = (_doNameWagoDODic["c_SRD1_200_FLIPPERS_IN"].Invert ^ _diNameWagoDIDic["r_SRD1_200_FLIPPER1_OUT"].Invert) ? !value : value;
  223. UpdataDIBytes("r_SRD1_200_FLIPPER1_OUT", value ? 0 : 1);
  224. UpdataDIBytes("r_SRD1_200_FLIPPER2_OUT", value ? 0 : 1);
  225. UpdataDIBytes("r_SRD1_200_FLIPPER3_OUT", value ? 0 : 1);
  226. }
  227. if (DONameIndexDic.ContainsKey("c_SRD2_200_FLIPPERS_IN") && position == DONameIndexDic["c_SRD2_200_FLIPPERS_IN"])
  228. {
  229. value = (_doNameWagoDODic["c_SRD2_200_FLIPPERS_IN"].Invert ^ _diNameWagoDIDic["r_SRD2_200_FLIPPER1_OUT"].Invert) ? !value : value;
  230. UpdataDIBytes("r_SRD2_200_FLIPPER1_OUT", value ? 0 : 1);
  231. UpdataDIBytes("r_SRD2_200_FLIPPER2_OUT", value ? 0 : 1);
  232. UpdataDIBytes("r_SRD2_200_FLIPPER3_OUT", value ? 0 : 1);
  233. }
  234. //Shuttle
  235. if (DONameIndexDic.ContainsKey("c_SRD1_Shutter_Close") && position == DONameIndexDic["c_SRD1_Shutter_Close"])
  236. {
  237. value = (_doNameWagoDODic["c_SRD1_Shutter_Close"].Invert ^ _diNameWagoDIDic["r_SRD1_SHUTTER_OPEN"].Invert) ? !value : value;
  238. UpdataDIBytes("r_SRD1_SHUTTER_OPEN", value ? 0 : 1);
  239. UpdataDIBytes("r_SRD1_SHUTTER_CLOSED", value ? 1 : 0);
  240. }
  241. if (DONameIndexDic.ContainsKey("c_SRD2_Shutter_Close") && position == DONameIndexDic["c_SRD2_Shutter_Close"])
  242. {
  243. value = (_doNameWagoDODic["c_SRD2_Shutter_Close"].Invert ^ _diNameWagoDIDic["r_SRD2_SHUTTER_OPEN"].Invert) ? !value : value;
  244. UpdataDIBytes("r_SRD2_SHUTTER_OPEN", value ? 0 : 1);
  245. UpdataDIBytes("r_SRD2_SHUTTER_CLOSED", value ? 1 : 0);
  246. }
  247. //Vacuum
  248. if (DONameIndexDic.ContainsKey("c_SRD1_CHUCK_VACUUM") && position == DONameIndexDic["c_SRD1_CHUCK_VACUUM"])
  249. {
  250. value = (_doNameWagoDODic["c_SRD1_CHUCK_VACUUM"].Invert ) ? !value : value;
  251. _srd1currentVacuumValue = value ? _srd1currentVacuumValue : 4000;
  252. UpdataAIShorts("r_SRD1_CHUCK_VACUUM_anlg", _srd1currentVacuumValue);
  253. UpdataDIBytes("r_SRD1_CHUCK_VAC_OK", value ? 0 : 1);
  254. }
  255. if (DONameIndexDic.ContainsKey("c_SRD2_CHUCK_VACUUM") && position == DONameIndexDic["c_SRD2_CHUCK_VACUUM"])
  256. {
  257. value = _doNameWagoDODic["c_SRD2_CHUCK_VACUUM"].Invert ? !value : value;
  258. _srd2currentVacuumValue = value ? _srd2currentVacuumValue : 4000;
  259. UpdataAIShorts("r_SRD2_CHUCK_VACUUM_anlg", _srd2currentVacuumValue);
  260. UpdataDIBytes("r_SRD2_CHUCK_VAC_OK", value ? 0 : 1);
  261. }
  262. if (DONameIndexDic.ContainsKey("c_SRD1_CHUCK_ATM_ON") && position == DONameIndexDic["c_SRD1_CHUCK_ATM_ON"])
  263. {
  264. value = _doNameWagoDODic["c_SRD1_CHUCK_ATM_ON"].Invert ? !value : value;
  265. _srd1currentVacuumValue = value ? _srd1currentVacuumValue + 6000 : _srd1currentVacuumValue;
  266. UpdataAIShorts("r_SRD1_CHUCK_VACUUM_anlg", _srd1currentVacuumValue);
  267. }
  268. if (DONameIndexDic.ContainsKey("c_SRD2_CHUCK_ATM_ON") && position == DONameIndexDic["c_SRD2_CHUCK_ATM_ON"])
  269. {
  270. value = _doNameWagoDODic["c_SRD2_CHUCK_ATM_ON"].Invert ? !value : value;
  271. _srd2currentVacuumValue = value ? _srd2currentVacuumValue + 6000 : _srd2currentVacuumValue;
  272. UpdataAIShorts("r_SRD2_CHUCK_VACUUM_anlg", _srd2currentVacuumValue);
  273. }
  274. //Water
  275. if (DONameIndexDic.ContainsKey("c_SRD1_WATER_ON") && position == DONameIndexDic["c_SRD1_WATER_ON"])
  276. {
  277. value = _doNameWagoDODic["c_SRD1_WATER_ON"].Invert ? !value : value;
  278. UpdataAIShorts("r_SRD1_WATER_FLOW", value ? 30000 : 3277);
  279. }
  280. if (DONameIndexDic.ContainsKey("c_SRD2_WATER_ON") && position == DONameIndexDic["c_SRD2_WATER_ON"])
  281. {
  282. value = _doNameWagoDODic["c_SRD2_WATER_ON"].Invert ? !value : value;
  283. UpdataAIShorts("r_SRD2_WATER_FLOW", value ? 30000 : 3277);
  284. }
  285. //Reservoir 1 pump
  286. if (DONameIndexDic.ContainsKey("c_RESERVOIR1_PUMP_ON") && position == DONameIndexDic["c_RESERVOIR1_PUMP_ON"])
  287. {
  288. value = _doNameWagoDODic["c_RESERVOIR1_PUMP_ON"].Invert ? !value : value;
  289. UpdataDIBytes("r_RESERVOIR1_PUMP_ON", value ? 1 : 0);
  290. }
  291. }
  292. /// <summary>
  293. /// 初始化字典
  294. /// </summary>
  295. private void InitializeData(int port) //端口用于初始化不同Wago设备的字典
  296. {
  297. //加载对应配置文件 WagoControllerCfg-Simulator.xml
  298. try
  299. {
  300. string oldXmlPath = PathManager.GetCfgDir();
  301. string newXmlPath = oldXmlPath.Replace("CyberX8_Simulator", "CyberX8_RT") + "Devices\\WagoControllerCfg-Simulator.xml";
  302. WagoControllerCfg cfg = CustomXmlSerializer.Deserialize<WagoControllerCfg>(new FileInfo(newXmlPath));
  303. if (cfg != null)
  304. {
  305. foreach (WagoDeviceConfig config in cfg.WagoDeviceConfigs)
  306. {
  307. if (port == config.Port)
  308. {
  309. if(config.Module == "Loader" && _LoaderPeriodicJob == null)
  310. {
  311. _LoaderPeriodicJob = new PeriodicJob(100, OnTimer, $"Wago {config.Module} timer",true);
  312. }
  313. if (config.Module == "Wago2" && _Wago2PeriodicJob == null)
  314. {
  315. _Wago2PeriodicJob = new PeriodicJob(100, OnTimer1, $"Wago {config.Module} timer", true);
  316. }
  317. if (config.Module == "Wago4" && _Wago2PeriodicJob == null)
  318. {
  319. _Wago2PeriodicJob = new PeriodicJob(100, OnTimer3, $"Wago {config.Module} timer", true);
  320. }
  321. //加载DO
  322. int i = 0;
  323. DONameIndexDic = new Dictionary<string, int>();
  324. if(config.WagoDigOut != null && config.WagoDigOut.WagoDOGroups != null)
  325. {
  326. foreach (var group in config.WagoDigOut.WagoDOGroups)
  327. {
  328. foreach (var item in group.WagoDOs)
  329. {
  330. DONameIndexDic[item.Name] = i;
  331. i++;
  332. _doNameWagoDODic[item.Name] = item;
  333. }
  334. }
  335. }
  336. //加载DI
  337. i = 0;
  338. DINameIndexDic = new Dictionary<string, int>();
  339. if(config.WagoDigIn != null && config.WagoDigIn.WagoDIGroups != null)
  340. {
  341. foreach (var group in config.WagoDigIn.WagoDIGroups)
  342. {
  343. foreach (var item in group.WagoDIs)
  344. {
  345. DINameIndexDic[item.Name] = i;
  346. i++;
  347. _diNameWagoDIDic[item.Name] = item;
  348. }
  349. }
  350. }
  351. //加载AO
  352. i = 0;
  353. AONameIndexDic = new Dictionary<string, int>();
  354. if (config.WagoAnoOut != null && config.WagoAnoOut.WagoAOGroups != null)
  355. {
  356. foreach (var group in config.WagoAnoOut.WagoAOGroups)
  357. {
  358. foreach (var item in group.WagoAOs)
  359. {
  360. AONameIndexDic[item.Name] = i;
  361. i++;
  362. }
  363. }
  364. }
  365. //加载AI
  366. i = 0;
  367. AINameIndexDic = new Dictionary<string, int>();
  368. if (config.WagoAnoIn != null && config.WagoAnoIn.WagoAIGroups != null)
  369. {
  370. foreach (var group in config.WagoAnoIn.WagoAIGroups)
  371. {
  372. foreach (var item in group.WagoAIs)
  373. {
  374. AINameIndexDic[item.Name] = i;
  375. i++;
  376. }
  377. }
  378. }
  379. }
  380. }
  381. }
  382. }
  383. catch
  384. {
  385. LOG.WriteLog(eEvent.ERR_WAGO, "Wago", "Load wago WagoControllerCfg-Simulator.xml failed");
  386. }
  387. //设置IO变量默认值
  388. if (AINameIndexDic.ContainsKey("r_LoaderA_LS_Vacuum_anlg")) AIShorts[AINameIndexDic["r_LoaderA_LS_Vacuum_anlg"]] = 0x32C8;
  389. if (AINameIndexDic.ContainsKey("r_LoaderB_LS_Vacuum_anlg")) AIShorts[AINameIndexDic["r_LoaderB_LS_Vacuum_anlg"]] = 0x32C8;
  390. if (AINameIndexDic.ContainsKey("r_DPUF_A_CHUCK_A_VAC")) AIShorts[AINameIndexDic["r_DPUF_A_CHUCK_A_VAC"]] = 0x32C8;
  391. if (AINameIndexDic.ContainsKey("r_DPUF_A_CHUCK_B_VAC")) AIShorts[AINameIndexDic["r_DPUF_A_CHUCK_B_VAC"]] = 0x32C8;
  392. if (AINameIndexDic.ContainsKey("r_SYSTEM_EXHAUST")) AIShorts[AINameIndexDic["r_SYSTEM_EXHAUST"]] = 0x3A98;
  393. if (DONameIndexDic.ContainsKey("c_HVD_1_ENABLE")) DOBytes[DONameIndexDic["c_HVD_1_ENABLE"]] = 1;
  394. if (DONameIndexDic.ContainsKey("c_HVD_2_ENABLE")) DOBytes[DONameIndexDic["c_HVD_2_ENABLE"]] = 1;
  395. //QDR
  396. if (AINameIndexDic.ContainsKey("r_QDRD1_WATER_LEVEL")) AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] = 0;
  397. if (AINameIndexDic.ContainsKey("r_QDRD2_WATER_LEVEL")) AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] = 0;
  398. if (AINameIndexDic.ContainsKey("r_QDRD3_WATER_LEVEL")) AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] = 0;
  399. if (AINameIndexDic.ContainsKey("r_QDRD4_WATER_LEVEL")) AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] = 0;
  400. //SRD
  401. if (AINameIndexDic.ContainsKey("r_SRD1_CHUCK_VACUUM_anlg")) AIShorts[AINameIndexDic["r_SRD1_CHUCK_VACUUM_anlg"]] = 15000;
  402. if (AINameIndexDic.ContainsKey("r_SRD2_CHUCK_VACUUM_anlg")) AIShorts[AINameIndexDic["r_SRD2_CHUCK_VACUUM_anlg"]] = 15000;
  403. if (DINameIndexDic.ContainsKey("r_SRD1_SHUTTER_OPEN")) DIBytes[DINameIndexDic["r_SRD1_SHUTTER_OPEN"]] = 1;
  404. if (DINameIndexDic.ContainsKey("r_SRD1_SHUTTER_CLOSED")) DIBytes[DINameIndexDic["r_SRD1_SHUTTER_CLOSED"]] = 0;
  405. if (DINameIndexDic.ContainsKey("r_SRD2_SHUTTER_OPEN")) DIBytes[DINameIndexDic["r_SRD2_SHUTTER_OPEN"]] = 1;
  406. if (DINameIndexDic.ContainsKey("r_SRD2_SHUTTER_CLOSED")) DIBytes[DINameIndexDic["r_SRD2_SHUTTER_CLOSED"]] = 0;
  407. if (DINameIndexDic.ContainsKey("r_SRD_FLUID_LEVEL")) DIBytes[DINameIndexDic["r_SRD_FLUID_LEVEL"]] = 1;
  408. if (DINameIndexDic.ContainsKey("r_SRD1_CHUCK_VAC_OK")) DIBytes[DINameIndexDic["r_SRD1_CHUCK_VAC_OK"]] = 1;
  409. if (DINameIndexDic.ContainsKey("r_SRD2_CHUCK_VAC_OK")) DIBytes[DINameIndexDic["r_SRD2_CHUCK_VAC_OK"]] = 1;
  410. if (DINameIndexDic.ContainsKey("r_SRD1_150_FLIPPER1_OUT")) DIBytes[DINameIndexDic["r_SRD1_150_FLIPPER1_OUT"]] = 1;
  411. if (DINameIndexDic.ContainsKey("r_SRD1_150_FLIPPER2_OUT")) DIBytes[DINameIndexDic["r_SRD1_150_FLIPPER2_OUT"]] = 1;
  412. if (DINameIndexDic.ContainsKey("r_SRD1_150_FLIPPER3_OUT")) DIBytes[DINameIndexDic["r_SRD1_150_FLIPPER3_OUT"]] = 1;
  413. if (DINameIndexDic.ContainsKey("r_SRD1_200_FLIPPER1_OUT")) DIBytes[DINameIndexDic["r_SRD1_200_FLIPPER1_OUT"]] = 1;
  414. if (DINameIndexDic.ContainsKey("r_SRD1_200_FLIPPER2_OUT")) DIBytes[DINameIndexDic["r_SRD1_200_FLIPPER2_OUT"]] = 1;
  415. if (DINameIndexDic.ContainsKey("r_SRD1_200_FLIPPER3_OUT")) DIBytes[DINameIndexDic["r_SRD1_200_FLIPPER3_OUT"]] = 1;
  416. if (DINameIndexDic.ContainsKey("r_SRD2_150_FLIPPER1_OUT")) DIBytes[DINameIndexDic["r_SRD2_150_FLIPPER1_OUT"]] = 1;
  417. if (DINameIndexDic.ContainsKey("r_SRD2_150_FLIPPER2_OUT")) DIBytes[DINameIndexDic["r_SRD2_150_FLIPPER2_OUT"]] = 1;
  418. if (DINameIndexDic.ContainsKey("r_SRD2_150_FLIPPER3_OUT")) DIBytes[DINameIndexDic["r_SRD2_150_FLIPPER3_OUT"]] = 1;
  419. if (DINameIndexDic.ContainsKey("r_SRD2_200_FLIPPER1_OUT")) DIBytes[DINameIndexDic["r_SRD2_200_FLIPPER1_OUT"]] = 1;
  420. if (DINameIndexDic.ContainsKey("r_SRD2_200_FLIPPER2_OUT")) DIBytes[DINameIndexDic["r_SRD2_200_FLIPPER2_OUT"]] = 1;
  421. if (DINameIndexDic.ContainsKey("r_SRD2_200_FLIPPER3_OUT")) DIBytes[DINameIndexDic["r_SRD2_200_FLIPPER3_OUT"]] = 1;
  422. if (DONameIndexDic.ContainsKey("c_SRD1_150_FLIPPERS_IN")) DOBytes[DONameIndexDic["c_SRD1_150_FLIPPERS_IN"]] = 0;
  423. if (DONameIndexDic.ContainsKey("c_SRD2_150_FLIPPERS_IN")) DOBytes[DONameIndexDic["c_SRD2_150_FLIPPERS_IN"]] = 0;
  424. if (DONameIndexDic.ContainsKey("c_SRD1_200_FLIPPERS_IN")) DOBytes[DONameIndexDic["c_SRD1_200_FLIPPERS_IN"]] = 0;
  425. if (DONameIndexDic.ContainsKey("c_SRD2_200_FLIPPERS_IN")) DOBytes[DONameIndexDic["c_SRD2_200_FLIPPERS_IN"]] = 0;
  426. if (DONameIndexDic.ContainsKey("c_SRD1_LIFT_UP")) DOBytes[DONameIndexDic["c_SRD1_LIFT_UP"]] = 1;
  427. if (DONameIndexDic.ContainsKey("c_SRD2_LIFT_UP")) DOBytes[DONameIndexDic["c_SRD2_LIFT_UP"]] = 1;
  428. if (DINameIndexDic.ContainsKey("r_SRD1_WAFER_PRESENT")) DIBytes[DINameIndexDic["r_SRD1_WAFER_PRESENT"]] = 1;
  429. if (DINameIndexDic.ContainsKey("r_SRD2_WAFER_PRESENT")) DIBytes[DINameIndexDic["r_SRD2_WAFER_PRESENT"]] = 1;
  430. if (AINameIndexDic.ContainsKey("r_SRD_SUPPLY_WATER_PRESS")) AIShorts[AINameIndexDic["r_SRD_SUPPLY_WATER_PRESS"]] = 20000;
  431. //Metal
  432. if (AINameIndexDic.ContainsKey("r_PUMP4_FLOW")) AIShorts[AINameIndexDic["r_PUMP4_FLOW"]] = 0;
  433. if (AINameIndexDic.ContainsKey("r_PUMP3_FLOW")) AIShorts[AINameIndexDic["r_PUMP3_FLOW"]] = 0;
  434. if (AINameIndexDic.ContainsKey("r_PUMP2_FLOW")) AIShorts[AINameIndexDic["r_PUMP2_FLOW"]] = 0;
  435. if (AINameIndexDic.ContainsKey("r_PUMP1_FLOW")) AIShorts[AINameIndexDic["r_PUMP1_FLOW"]] = 0;
  436. //Facility
  437. if (AINameIndexDic.ContainsKey("r_DI_WATER_PRESSURE")) AIShorts[AINameIndexDic["r_DI_WATER_PRESSURE"]] = 12000;
  438. if (AINameIndexDic.ContainsKey("r_HCW_FLOW")) AIShorts[AINameIndexDic["r_HCW_FLOW"]] = 16300;
  439. if (AINameIndexDic.ContainsKey("r_N2_1B_PRESSURE")) AIShorts[AINameIndexDic["r_N2_1B_PRESSURE"]] = 5400;
  440. if (AINameIndexDic.ContainsKey("r_N2_1A_PRESSURE")) AIShorts[AINameIndexDic["r_N2_1A_PRESSURE"]] = 8900;
  441. if (AINameIndexDic.ContainsKey("r_N2_2B_PRESSURE")) AIShorts[AINameIndexDic["r_N2_2B_PRESSURE"]] = 5400;
  442. if (AINameIndexDic.ContainsKey("r_N2_2A_PRESSURE")) AIShorts[AINameIndexDic["r_N2_2A_PRESSURE"]] = 8900;
  443. if (AINameIndexDic.ContainsKey("r_SYSTEM_VACUUM")) AIShorts[AINameIndexDic["r_SYSTEM_VACUUM"]] = 3276;
  444. if (AINameIndexDic.ContainsKey("r_CDA_HIGH_PRESSURE")) AIShorts[AINameIndexDic["r_CDA_HIGH_PRESSURE"]] = 10000;
  445. if (AINameIndexDic.ContainsKey("r_CDA_LOW_PRESSURE")) AIShorts[AINameIndexDic["r_CDA_LOW_PRESSURE"]] = 10000;
  446. if (AINameIndexDic.ContainsKey("r_CDA_EXTERNAL_PRESSURE")) AIShorts[AINameIndexDic["r_CDA_EXTERNAL_PRESSURE"]] = 10000;
  447. if (AINameIndexDic.ContainsKey("r_pH3")) AIShorts[AINameIndexDic["r_pH3"]] = 15000;
  448. if (AINameIndexDic.ContainsKey("r_MBS3_FLOW")) AIShorts[AINameIndexDic["r_MBS3_FLOW"]] = 16000;
  449. //if (DINameIndexDic.ContainsKey("r_RES1_HIGH_LEVEL")) DIBytes[DINameIndexDic["r_RES1_HIGH_LEVEL"]] = 1;
  450. //Reservoie Level Law
  451. if (AINameIndexDic.ContainsKey("r_RES1_LEVEL_raw")) AIShorts[AINameIndexDic["r_RES1_LEVEL_raw"]] = 10000;
  452. if (AINameIndexDic.ContainsKey("r_RES2_LEVEL_raw")) AIShorts[AINameIndexDic["r_RES2_LEVEL_raw"]] = 10000;
  453. if (AINameIndexDic.ContainsKey("r_RES3_LEVEL_raw")) AIShorts[AINameIndexDic["r_RES3_LEVEL_raw"]] = 10000;
  454. if (AINameIndexDic.ContainsKey("r_RES4_LEVEL_raw")) AIShorts[AINameIndexDic["r_RES4_LEVEL_raw"]] = 10000;
  455. _festoDataBuffer["FlowTestClamp"] = false;
  456. }
  457. #region 公共方法
  458. public void UpdataDOBytes(string name,int value)
  459. {
  460. if (OnDOVariableValueChanged != null)
  461. {
  462. OnDOVariableValueChanged(name);
  463. }
  464. if (DONameIndexDic.ContainsKey(name))
  465. {
  466. if (DONameIndexDic[name] < DOBytes.Length)
  467. {
  468. DOBytes[DONameIndexDic[name]] = value == 0 ? (byte)0 : (byte)1;
  469. }
  470. }
  471. }
  472. public void UpdataDIBytes(string name, int value)
  473. {
  474. if (OnDIVariableValueChanged != null)
  475. {
  476. OnDIVariableValueChanged(name);
  477. }
  478. if (DINameIndexDic.ContainsKey(name))
  479. {
  480. if (DINameIndexDic[name] < DIBytes.Length)
  481. {
  482. DIBytes[DINameIndexDic[name]] = value == 0 ? (byte)0 : (byte)1;
  483. }
  484. }
  485. }
  486. public void UpdataAOShorts(string name, int value)
  487. {
  488. if (OnAOVariableValueChanged != null)
  489. {
  490. OnAOVariableValueChanged(name);
  491. }
  492. if (AONameIndexDic.ContainsKey(name))
  493. {
  494. string hexValue = value.ToString("X2");
  495. try
  496. {
  497. short result = Convert.ToInt16(hexValue, 16);
  498. if (AONameIndexDic[name] < AOShorts.Length)
  499. {
  500. AOShorts[AONameIndexDic[name]] = result;
  501. }
  502. }
  503. catch (FormatException)
  504. {
  505. }
  506. }
  507. }
  508. public void UpdataAIShorts(string name, int value)
  509. {
  510. if (OnAIVariableValueChanged != null)
  511. {
  512. OnAIVariableValueChanged(name);
  513. }
  514. if (AINameIndexDic.ContainsKey(name))
  515. {
  516. string hexValue = value.ToString("X2");
  517. try
  518. {
  519. short result = Convert.ToInt16(hexValue, 16);
  520. if(AINameIndexDic[name] < AIShorts.Length)
  521. {
  522. AIShorts[AINameIndexDic[name]] = result;
  523. }
  524. }
  525. catch (FormatException)
  526. {
  527. }
  528. }
  529. }
  530. #endregion
  531. #region 功能方法
  532. /// <summary>
  533. /// 将长度为8的二进制byte数组转成对应十六进制byte值(大端模式)
  534. /// </summary>
  535. /// <param name="byteArray"></param>
  536. /// <returns></returns>
  537. public byte ConvertByteArrayToHex(byte[] byteArray)
  538. {
  539. byte result = 0;
  540. // 先将 byte 数组转换为二进制数
  541. int binaryValue = 0;
  542. for (int i = 0; i < 8; i++)
  543. {
  544. binaryValue |= (byteArray[i] << (7 - i));
  545. }
  546. // 逆转二进制数
  547. int reversedValue = 0;
  548. for (int i = 0; i < 8; i++)
  549. {
  550. reversedValue |= ((binaryValue >> i) & 1) << (7 - i);
  551. }
  552. // 转换为十六进制byte
  553. if (byte.TryParse(reversedValue.ToString("X2"), System.Globalization.NumberStyles.HexNumber, null, out result))
  554. {
  555. return result;
  556. }
  557. return 0;
  558. }
  559. /// <summary>
  560. /// 将short数组转成长度两倍的byte数组
  561. /// </summary>
  562. /// <param name="shortArray"></param>
  563. /// <returns></returns>
  564. private byte[] ConvertShortArrayToByteArray(short[] shortArray)
  565. {
  566. byte[] byteArray = new byte[shortArray.Length * 2];
  567. for (int i = 0; i < shortArray.Length; i++)
  568. {
  569. byte[] tempBytes = BitConverter.GetBytes(shortArray[i]);
  570. Array.Reverse(tempBytes);
  571. Array.Copy(tempBytes, 0, byteArray, i * 2, 2);
  572. }
  573. return byteArray;
  574. }
  575. #endregion
  576. protected override void ProcessUnsplitMessage(byte[] data)
  577. {
  578. byte command = data[7];
  579. if (command == 0x01) //读DO
  580. {
  581. short flag = byteTransform.TransInt16(data, 0);
  582. byte channel = data[6];
  583. short startAddress = byteTransform.TransInt16(data, 8);
  584. short bitCount = byteTransform.TransInt16(data, 10);
  585. byte byteCount = (byte)(bitCount / 8 + 1);
  586. byte[] bytes = new byte[byteCount];
  587. for(int i = 0; i < byteCount;i++)
  588. {
  589. byte[] tempbytes = new byte[8];
  590. Array.Copy(DOBytes,8 * i, tempbytes, 0, 8);
  591. bytes[i] = ConvertByteArrayToHex(tempbytes);
  592. }
  593. OnWriteMessage(CreateReadDigitalResponse(flag, channel, command, byteCount, bytes));
  594. return;
  595. }
  596. else if(command == 0x03)//读AO
  597. {
  598. short flag = byteTransform.TransInt16(data, 0);
  599. byte channel = data[6];
  600. short startAddress = byteTransform.TransInt16(data, 8);
  601. short registerCount = byteTransform.TransInt16(data, 10);
  602. short[] shorts = new short[registerCount];//获取指定寄存器里的内容
  603. Array.Copy(AOShorts, 0, shorts, 0, registerCount);
  604. byte[] bytes = new byte[registerCount * 2];
  605. bytes = ConvertShortArrayToByteArray(shorts); //转入长度为shorts数组长度两倍的bytes数组中
  606. OnWriteMessage(CreateReadAnalogyResponse(flag, channel, command, (byte)registerCount, bytes));
  607. return;
  608. }
  609. else if (command == 0x02)//读DI
  610. {
  611. short flag = byteTransform.TransInt16(data, 0);
  612. byte channel = data[6];
  613. short startAddress = byteTransform.TransInt16(data, 8);
  614. short bitCount = byteTransform.TransInt16(data, 10);
  615. byte byteCount = (byte)(bitCount / 8 + 1);
  616. byte[] bytes = new byte[byteCount];
  617. for (int i = 0; i < byteCount; i++)
  618. {
  619. byte[] tempbytes = new byte[8];
  620. Array.Copy(DIBytes, 8 * i, tempbytes, 0, 8);
  621. bytes[i] = ConvertByteArrayToHex(tempbytes);
  622. }
  623. OnWriteMessage(CreateReadDigitalResponse(flag, channel, command, byteCount, bytes));
  624. return;
  625. }
  626. else if (command == 0x04)//读AI
  627. {
  628. short flag = byteTransform.TransInt16(data, 0);
  629. byte channel = data[6];
  630. short startAddress = byteTransform.TransInt16(data, 8);
  631. short registerCount = byteTransform.TransInt16(data, 10);
  632. short[] shorts = new short[registerCount];//获取指定寄存器里的内容
  633. Array.Copy(AIShorts, 0, shorts, 0, registerCount);
  634. byte[] bytes = new byte[registerCount * 2];
  635. bytes = ConvertShortArrayToByteArray(shorts); //转入长度为shorts数组两倍的bytes数组中
  636. OnWriteMessage(CreateReadAnalogyResponse(flag, channel, command, (byte)registerCount, bytes));
  637. return;
  638. }
  639. else if (command == 0x05)//写DO
  640. {
  641. short startAddress = byteTransform.TransInt16(data, 8);
  642. if (startAddress > 0x03FF || startAddress < WRITE_DO_STARTADDRESS)
  643. {
  644. short flag = byteTransform.TransInt16(data, 0);
  645. byte channel = data[6];
  646. OnWriteMessage(CreateError(flag, channel, command, 0x02)); //地址错误
  647. return;
  648. }
  649. int position = startAddress - WRITE_DO_STARTADDRESS;
  650. bool status = data[10] == 0xFF ? true : false;
  651. lock (_writeDOLocker)
  652. {
  653. DOBytes[position] = status ? (byte)1 : (byte)0;
  654. }
  655. OnWriteMessage(data); //原消息返回
  656. //触发Wago对应数据更新
  657. UpdateDataCausedByWago(position, status);
  658. return;
  659. }
  660. else if (command == 0x06)//写AO
  661. {
  662. short startAddress = byteTransform.TransInt16(data, 8);
  663. if(startAddress > 0x02FF || startAddress < WRITE_AO_STARTADDRESS)
  664. {
  665. short flag = byteTransform.TransInt16(data, 0);
  666. byte channel = data[6];
  667. OnWriteMessage(CreateError(flag, channel, command, 0x02)); //地址错误
  668. return;
  669. }
  670. int position = startAddress - WRITE_AO_STARTADDRESS;
  671. short value = byteTransform.TransInt16(data, 10);
  672. lock (_writeAOLocker)
  673. {
  674. AOShorts[position] = value;
  675. }
  676. OnWriteMessage(data); //原消息返回
  677. return;
  678. }
  679. else
  680. {
  681. short flag = byteTransform.TransInt16(data, 0);
  682. byte channel = data[6];
  683. OnWriteMessage(CreateError(flag, channel, command, 0x01)); //指令错误
  684. return;
  685. }
  686. }
  687. /// <summary>
  688. /// 回复读数字量
  689. /// </summary>
  690. /// <param name="flag"></param>
  691. /// <param name="channel"></param>
  692. /// <param name="command"></param>
  693. /// <param name="byteCount"></param>
  694. /// <param name="values"></param>
  695. /// <returns></returns>
  696. private byte[] CreateReadDigitalResponse(short flag, byte channel, byte command, byte byteCount, byte[] values)
  697. {
  698. byte[] bytes = new byte[7 + 2 + values.Length]; //回复字节长度,前面7个字节固定长度 + functionCode一个字节 + byteCount一个字节+values.length个字节
  699. Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
  700. bytes[2] = 0x00;
  701. bytes[3] = 0x00;
  702. short dataLength = (short)(3 + values.Length);
  703. Array.Copy(byteTransform.GetBytes(dataLength), 0, bytes, 4, 2);
  704. bytes[6] = channel;
  705. bytes[7] = command;
  706. bytes[8] = byteCount;
  707. Array.Copy(values, 0, bytes, 9, values.Length);
  708. return bytes;
  709. }
  710. /// <summary>
  711. /// 回复读模拟量
  712. /// </summary>
  713. /// <param name="flag"></param>
  714. /// <param name="channel"></param>
  715. /// <param name="command"></param>
  716. /// <param name="registerCount"></param>
  717. /// <param name="values"></param>
  718. /// <returns></returns>
  719. private byte[] CreateReadAnalogyResponse(short flag, byte channel, byte command, byte registerCount, byte[] values)
  720. {
  721. byte[] bytes = new byte[7 + 2 + 2 * registerCount]; //回复字节长度,前面7个字节固定长度 + functionCode一个字节 + byteCount一个字节+registerCount*2个字节(一个寄存器占两个字节)
  722. Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
  723. bytes[2] = 0x00;
  724. bytes[3] = 0x00;
  725. short dataLength = (short)(3 + 2 * registerCount);
  726. Array.Copy(byteTransform.GetBytes(dataLength), 0, bytes, 4, 2);
  727. bytes[6] = channel;
  728. bytes[7] = command;
  729. bytes[8] = (byte)(2 * registerCount);
  730. Array.Copy(values, 0, bytes, 9, values.Length);
  731. return bytes;
  732. }
  733. /// <summary>
  734. /// 错误回复
  735. /// </summary>
  736. /// <param name="flag"></param>
  737. /// <param name="channel"></param>
  738. /// <param name="command"></param>
  739. /// <param name="error"></param>
  740. /// <returns></returns>
  741. private byte[] CreateError(short flag, byte channel, byte command, byte error)
  742. {
  743. byte[] bytes = new byte[9];
  744. Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
  745. bytes[2] = 0x00;
  746. bytes[3] = 0x00;
  747. bytes[4] = 0x00;
  748. bytes[5] = 0x03;
  749. bytes[6] = channel;
  750. bytes[7] = (byte)(command | 0x80);
  751. bytes[8] = error;
  752. return bytes;
  753. }
  754. /// <summary>
  755. /// loader 定时器
  756. /// </summary>
  757. /// <returns></returns>
  758. private bool OnTimer()
  759. {
  760. LeakTestSimulator();
  761. return true;
  762. }
  763. /// <summary>
  764. /// Wago2定时器
  765. /// </summary>
  766. /// <returns></returns>
  767. private bool OnTimer1()
  768. {
  769. RinseWaterLevelSimulator();
  770. PumpFlowSimulator();
  771. return true;
  772. }
  773. /// <summary>
  774. /// Wago4定时器
  775. /// </summary>
  776. /// <returns></returns>
  777. private bool OnTimer3()
  778. {
  779. Pump1FlowSimulator();
  780. return true;
  781. }
  782. #region 模拟方法
  783. /// <summary>
  784. /// Loader LeakTest模拟
  785. /// </summary>
  786. private void LeakTestSimulator()
  787. {
  788. try
  789. {
  790. if (DOBytes[DONameIndexDic["c_VACUUM_TEST"]] == 1 && _festoDataBuffer["FlowTestClamp"] && AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] == 0)
  791. {
  792. AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] = 15000;
  793. }
  794. else if (DOBytes[DONameIndexDic["c_VACUUM_TEST"]] == 0 && !_festoDataBuffer["FlowTestClamp"])
  795. {
  796. AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] = 0;
  797. }
  798. if (DOBytes[DONameIndexDic["c_VACUUM_TEST"]] == 1 && _festoDataBuffer["FlowTestClamp"] && AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] > 3500)
  799. {
  800. AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] -= 40;
  801. if (AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] < 14000)
  802. {
  803. AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] -= 140;
  804. }
  805. }
  806. }
  807. catch
  808. {
  809. }
  810. }
  811. /// <summary>
  812. /// QDR水位模拟
  813. /// </summary>
  814. private void RinseWaterLevelSimulator()
  815. {
  816. //QDR1
  817. if (_rinse1FillValve && AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] < 25000)
  818. {
  819. AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] += 250;
  820. }
  821. if (_rinse1DumpValve && AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] > 500) //快排
  822. {
  823. AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] -= 600;
  824. }
  825. if (AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] > 500)//慢排
  826. {
  827. AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] -= 2;
  828. }
  829. //QDR2
  830. if (_rinse2FillValve && AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] < 25000)
  831. {
  832. AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] += 250;
  833. }
  834. if (_rinse2DumpValve && AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] > 500)
  835. {
  836. AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] -= 600;
  837. }
  838. if (AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] > 500)//慢排
  839. {
  840. AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] -= 2;
  841. }
  842. //QDR3
  843. if (_rinse3FillValve && AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] < 25000)
  844. {
  845. AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] += 250;
  846. }
  847. if (_rinse3DumpValve && AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] > 500)
  848. {
  849. AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] -= 600;
  850. }
  851. if (AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] > 500)//慢排
  852. {
  853. AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] -= 2;
  854. }
  855. //QDR4
  856. if (_rinse4FillValve && AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] < 25000)
  857. {
  858. AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] += 250;
  859. }
  860. if (_rinse4DumpValve && AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] > 500)
  861. {
  862. AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] -= 600;
  863. }
  864. if (AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] > 500)//慢排
  865. {
  866. AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] -= 2;
  867. }
  868. //reservoir1 pump flow
  869. AIShorts[AINameIndexDic["r_PUMP1_FLOW"]] = _reservoir1PumpOn ? (short)6000 : (short)0;
  870. }
  871. /// <summary>
  872. /// metal 2/3/4 pump流量模拟
  873. /// </summary>
  874. private void PumpFlowSimulator()
  875. {
  876. if (DOBytes[DONameIndexDic["c_METAL3_PUMP_ON"]] == 1)
  877. {
  878. AIShorts[AINameIndexDic["r_PUMP3_FLOW"]] = 6000;
  879. }
  880. else
  881. {
  882. AIShorts[AINameIndexDic["r_PUMP3_FLOW"]] = 0;
  883. }
  884. if (DOBytes[DONameIndexDic["c_METAL2_PUMP_ON"]] == 1)
  885. {
  886. AIShorts[AINameIndexDic["r_PUMP2_FLOW"]] = 6000;
  887. }
  888. else
  889. {
  890. AIShorts[AINameIndexDic["r_PUMP2_FLOW"]] = 0;
  891. }
  892. if (DOBytes[DONameIndexDic["c_METAL4_PUMP_ON"]] == 1)
  893. {
  894. AIShorts[AINameIndexDic["r_PUMP4_FLOW"]] = 6000;
  895. }
  896. else
  897. {
  898. AIShorts[AINameIndexDic["r_PUMP4_FLOW"]] = 0;
  899. }
  900. }
  901. /// <summary>
  902. /// Reservoir1 pump流量模拟
  903. /// </summary>
  904. private void Pump1FlowSimulator()
  905. {
  906. if (DONameIndexDic.ContainsKey("c_RESERVOIR1_PUMP_ON") && DOBytes[DONameIndexDic["c_RESERVOIR1_PUMP_ON"]] == 1)
  907. {
  908. SimulatorCommManager.Instance.CheckDataChanged("c_RESERVOIR1_PUMP_ON",true,false);
  909. }
  910. else if (DONameIndexDic.ContainsKey("c_RESERVOIR1_PUMP_ON") && DOBytes[DONameIndexDic["c_RESERVOIR1_PUMP_ON"]] == 0)
  911. {
  912. SimulatorCommManager.Instance.CheckDataChanged("c_RESERVOIR1_PUMP_ON", false, false);
  913. }
  914. }
  915. #endregion
  916. }
  917. }