WagoSocketSimulator.cs 46 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955
  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 ? 10000 : 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 ? 10000 : 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. //Reservoie Level Law
  450. if (AINameIndexDic.ContainsKey("r_RES1_LEVEL_raw")) AIShorts[AINameIndexDic["r_RES1_LEVEL_raw"]] = 10000;
  451. if (AINameIndexDic.ContainsKey("r_RES2_LEVEL_raw")) AIShorts[AINameIndexDic["r_RES2_LEVEL_raw"]] = 10000;
  452. if (AINameIndexDic.ContainsKey("r_RES3_LEVEL_raw")) AIShorts[AINameIndexDic["r_RES3_LEVEL_raw"]] = 10000;
  453. if (AINameIndexDic.ContainsKey("r_RES4_LEVEL_raw")) AIShorts[AINameIndexDic["r_RES4_LEVEL_raw"]] = 10000;
  454. _festoDataBuffer["FlowTestClamp"] = false;
  455. }
  456. #region 公共方法
  457. public void UpdataDOBytes(string name,int value)
  458. {
  459. if (OnDOVariableValueChanged != null)
  460. {
  461. OnDOVariableValueChanged(name);
  462. }
  463. if (DONameIndexDic.ContainsKey(name))
  464. {
  465. if (DONameIndexDic[name] < DOBytes.Length)
  466. {
  467. DOBytes[DONameIndexDic[name]] = value == 0 ? (byte)0 : (byte)1;
  468. }
  469. }
  470. }
  471. public void UpdataDIBytes(string name, int value)
  472. {
  473. if (OnDIVariableValueChanged != null)
  474. {
  475. OnDIVariableValueChanged(name);
  476. }
  477. if (DINameIndexDic.ContainsKey(name))
  478. {
  479. if (DINameIndexDic[name] < DIBytes.Length)
  480. {
  481. DIBytes[DINameIndexDic[name]] = value == 0 ? (byte)0 : (byte)1;
  482. }
  483. }
  484. }
  485. public void UpdataAOShorts(string name, int value)
  486. {
  487. if (OnAOVariableValueChanged != null)
  488. {
  489. OnAOVariableValueChanged(name);
  490. }
  491. if (AONameIndexDic.ContainsKey(name))
  492. {
  493. string hexValue = value.ToString("X2");
  494. try
  495. {
  496. short result = Convert.ToInt16(hexValue, 16);
  497. if (AONameIndexDic[name] < AOShorts.Length)
  498. {
  499. AOShorts[AONameIndexDic[name]] = result;
  500. }
  501. }
  502. catch (FormatException)
  503. {
  504. }
  505. }
  506. }
  507. public void UpdataAIShorts(string name, int value)
  508. {
  509. if (OnAIVariableValueChanged != null)
  510. {
  511. OnAIVariableValueChanged(name);
  512. }
  513. if (AINameIndexDic.ContainsKey(name))
  514. {
  515. string hexValue = value.ToString("X2");
  516. try
  517. {
  518. short result = Convert.ToInt16(hexValue, 16);
  519. if(AINameIndexDic[name] < AIShorts.Length)
  520. {
  521. AIShorts[AINameIndexDic[name]] = result;
  522. }
  523. }
  524. catch (FormatException)
  525. {
  526. }
  527. }
  528. }
  529. #endregion
  530. #region 功能方法
  531. /// <summary>
  532. /// 将长度为8的二进制byte数组转成对应十六进制byte值(大端模式)
  533. /// </summary>
  534. /// <param name="byteArray"></param>
  535. /// <returns></returns>
  536. public byte ConvertByteArrayToHex(byte[] byteArray)
  537. {
  538. byte result = 0;
  539. // 先将 byte 数组转换为二进制数
  540. int binaryValue = 0;
  541. for (int i = 0; i < 8; i++)
  542. {
  543. binaryValue |= (byteArray[i] << (7 - i));
  544. }
  545. // 逆转二进制数
  546. int reversedValue = 0;
  547. for (int i = 0; i < 8; i++)
  548. {
  549. reversedValue |= ((binaryValue >> i) & 1) << (7 - i);
  550. }
  551. // 转换为十六进制byte
  552. if (byte.TryParse(reversedValue.ToString("X2"), System.Globalization.NumberStyles.HexNumber, null, out result))
  553. {
  554. return result;
  555. }
  556. return 0;
  557. }
  558. /// <summary>
  559. /// 将short数组转成长度两倍的byte数组
  560. /// </summary>
  561. /// <param name="shortArray"></param>
  562. /// <returns></returns>
  563. private byte[] ConvertShortArrayToByteArray(short[] shortArray)
  564. {
  565. byte[] byteArray = new byte[shortArray.Length * 2];
  566. for (int i = 0; i < shortArray.Length; i++)
  567. {
  568. byte[] tempBytes = BitConverter.GetBytes(shortArray[i]);
  569. Array.Reverse(tempBytes);
  570. Array.Copy(tempBytes, 0, byteArray, i * 2, 2);
  571. }
  572. return byteArray;
  573. }
  574. #endregion
  575. protected override void ProcessUnsplitMessage(byte[] data)
  576. {
  577. byte command = data[7];
  578. if (command == 0x01) //读DO
  579. {
  580. short flag = byteTransform.TransInt16(data, 0);
  581. byte channel = data[6];
  582. short startAddress = byteTransform.TransInt16(data, 8);
  583. short bitCount = byteTransform.TransInt16(data, 10);
  584. byte byteCount = (byte)(bitCount / 8 + 1);
  585. byte[] bytes = new byte[byteCount];
  586. for(int i = 0; i < byteCount;i++)
  587. {
  588. byte[] tempbytes = new byte[8];
  589. Array.Copy(DOBytes,8 * i, tempbytes, 0, 8);
  590. bytes[i] = ConvertByteArrayToHex(tempbytes);
  591. }
  592. OnWriteMessage(CreateReadDigitalResponse(flag, channel, command, byteCount, bytes));
  593. return;
  594. }
  595. else if(command == 0x03)//读AO
  596. {
  597. short flag = byteTransform.TransInt16(data, 0);
  598. byte channel = data[6];
  599. short startAddress = byteTransform.TransInt16(data, 8);
  600. short registerCount = byteTransform.TransInt16(data, 10);
  601. short[] shorts = new short[registerCount];//获取指定寄存器里的内容
  602. Array.Copy(AOShorts, 0, shorts, 0, registerCount);
  603. byte[] bytes = new byte[registerCount * 2];
  604. bytes = ConvertShortArrayToByteArray(shorts); //转入长度为shorts数组长度两倍的bytes数组中
  605. OnWriteMessage(CreateReadAnalogyResponse(flag, channel, command, (byte)registerCount, bytes));
  606. return;
  607. }
  608. else if (command == 0x02)//读DI
  609. {
  610. short flag = byteTransform.TransInt16(data, 0);
  611. byte channel = data[6];
  612. short startAddress = byteTransform.TransInt16(data, 8);
  613. short bitCount = byteTransform.TransInt16(data, 10);
  614. byte byteCount = (byte)(bitCount / 8 + 1);
  615. byte[] bytes = new byte[byteCount];
  616. for (int i = 0; i < byteCount; i++)
  617. {
  618. byte[] tempbytes = new byte[8];
  619. Array.Copy(DIBytes, 8 * i, tempbytes, 0, 8);
  620. bytes[i] = ConvertByteArrayToHex(tempbytes);
  621. }
  622. OnWriteMessage(CreateReadDigitalResponse(flag, channel, command, byteCount, bytes));
  623. return;
  624. }
  625. else if (command == 0x04)//读AI
  626. {
  627. short flag = byteTransform.TransInt16(data, 0);
  628. byte channel = data[6];
  629. short startAddress = byteTransform.TransInt16(data, 8);
  630. short registerCount = byteTransform.TransInt16(data, 10);
  631. short[] shorts = new short[registerCount];//获取指定寄存器里的内容
  632. Array.Copy(AIShorts, 0, shorts, 0, registerCount);
  633. byte[] bytes = new byte[registerCount * 2];
  634. bytes = ConvertShortArrayToByteArray(shorts); //转入长度为shorts数组两倍的bytes数组中
  635. OnWriteMessage(CreateReadAnalogyResponse(flag, channel, command, (byte)registerCount, bytes));
  636. return;
  637. }
  638. else if (command == 0x05)//写DO
  639. {
  640. short startAddress = byteTransform.TransInt16(data, 8);
  641. if (startAddress > 0x03FF || startAddress < WRITE_DO_STARTADDRESS)
  642. {
  643. short flag = byteTransform.TransInt16(data, 0);
  644. byte channel = data[6];
  645. OnWriteMessage(CreateError(flag, channel, command, 0x02)); //地址错误
  646. return;
  647. }
  648. int position = startAddress - WRITE_DO_STARTADDRESS;
  649. bool status = data[10] == 0xFF ? true : false;
  650. lock (_writeDOLocker)
  651. {
  652. DOBytes[position] = status ? (byte)1 : (byte)0;
  653. }
  654. OnWriteMessage(data); //原消息返回
  655. //触发Wago对应数据更新
  656. UpdateDataCausedByWago(position, status);
  657. return;
  658. }
  659. else if (command == 0x06)//写AO
  660. {
  661. short startAddress = byteTransform.TransInt16(data, 8);
  662. if(startAddress > 0x02FF || startAddress < WRITE_AO_STARTADDRESS)
  663. {
  664. short flag = byteTransform.TransInt16(data, 0);
  665. byte channel = data[6];
  666. OnWriteMessage(CreateError(flag, channel, command, 0x02)); //地址错误
  667. return;
  668. }
  669. int position = startAddress - WRITE_AO_STARTADDRESS;
  670. short value = byteTransform.TransInt16(data, 10);
  671. lock (_writeAOLocker)
  672. {
  673. AOShorts[position] = value;
  674. }
  675. OnWriteMessage(data); //原消息返回
  676. return;
  677. }
  678. else
  679. {
  680. short flag = byteTransform.TransInt16(data, 0);
  681. byte channel = data[6];
  682. OnWriteMessage(CreateError(flag, channel, command, 0x01)); //指令错误
  683. return;
  684. }
  685. }
  686. /// <summary>
  687. /// 回复读数字量
  688. /// </summary>
  689. /// <param name="flag"></param>
  690. /// <param name="channel"></param>
  691. /// <param name="command"></param>
  692. /// <param name="byteCount"></param>
  693. /// <param name="values"></param>
  694. /// <returns></returns>
  695. private byte[] CreateReadDigitalResponse(short flag, byte channel, byte command, byte byteCount, byte[] values)
  696. {
  697. byte[] bytes = new byte[7 + 2 + values.Length]; //回复字节长度,前面7个字节固定长度 + functionCode一个字节 + byteCount一个字节+values.length个字节
  698. Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
  699. bytes[2] = 0x00;
  700. bytes[3] = 0x00;
  701. short dataLength = (short)(3 + values.Length);
  702. Array.Copy(byteTransform.GetBytes(dataLength), 0, bytes, 4, 2);
  703. bytes[6] = channel;
  704. bytes[7] = command;
  705. bytes[8] = byteCount;
  706. Array.Copy(values, 0, bytes, 9, values.Length);
  707. return bytes;
  708. }
  709. /// <summary>
  710. /// 回复读模拟量
  711. /// </summary>
  712. /// <param name="flag"></param>
  713. /// <param name="channel"></param>
  714. /// <param name="command"></param>
  715. /// <param name="registerCount"></param>
  716. /// <param name="values"></param>
  717. /// <returns></returns>
  718. private byte[] CreateReadAnalogyResponse(short flag, byte channel, byte command, byte registerCount, byte[] values)
  719. {
  720. byte[] bytes = new byte[7 + 2 + 2 * registerCount]; //回复字节长度,前面7个字节固定长度 + functionCode一个字节 + byteCount一个字节+registerCount*2个字节(一个寄存器占两个字节)
  721. Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
  722. bytes[2] = 0x00;
  723. bytes[3] = 0x00;
  724. short dataLength = (short)(3 + 2 * registerCount);
  725. Array.Copy(byteTransform.GetBytes(dataLength), 0, bytes, 4, 2);
  726. bytes[6] = channel;
  727. bytes[7] = command;
  728. bytes[8] = (byte)(2 * registerCount);
  729. Array.Copy(values, 0, bytes, 9, values.Length);
  730. return bytes;
  731. }
  732. /// <summary>
  733. /// 错误回复
  734. /// </summary>
  735. /// <param name="flag"></param>
  736. /// <param name="channel"></param>
  737. /// <param name="command"></param>
  738. /// <param name="error"></param>
  739. /// <returns></returns>
  740. private byte[] CreateError(short flag, byte channel, byte command, byte error)
  741. {
  742. byte[] bytes = new byte[9];
  743. Array.Copy(byteTransform.GetBytes(flag), 0, bytes, 0, 2);
  744. bytes[2] = 0x00;
  745. bytes[3] = 0x00;
  746. bytes[4] = 0x00;
  747. bytes[5] = 0x03;
  748. bytes[6] = channel;
  749. bytes[7] = (byte)(command | 0x80);
  750. bytes[8] = error;
  751. return bytes;
  752. }
  753. /// <summary>
  754. /// loader 定时器
  755. /// </summary>
  756. /// <returns></returns>
  757. private bool OnTimer()
  758. {
  759. LeakTestSimulator();
  760. return true;
  761. }
  762. /// <summary>
  763. /// Wago2定时器
  764. /// </summary>
  765. /// <returns></returns>
  766. private bool OnTimer1()
  767. {
  768. RinseWaterLevelSimulator();
  769. PumpFlowSimulator();
  770. return true;
  771. }
  772. /// <summary>
  773. /// Wago4定时器
  774. /// </summary>
  775. /// <returns></returns>
  776. private bool OnTimer3()
  777. {
  778. Pump1FlowSimulator();
  779. return true;
  780. }
  781. #region 模拟方法
  782. /// <summary>
  783. /// Loader LeakTest模拟
  784. /// </summary>
  785. private void LeakTestSimulator()
  786. {
  787. try
  788. {
  789. if (DOBytes[DONameIndexDic["c_VACUUM_TEST"]] == 1 && _festoDataBuffer["FlowTestClamp"] && AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] == 0)
  790. {
  791. AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] = 15000;
  792. }
  793. else if (DOBytes[DONameIndexDic["c_VACUUM_TEST"]] == 0 && !_festoDataBuffer["FlowTestClamp"])
  794. {
  795. AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] = 0;
  796. }
  797. if (DOBytes[DONameIndexDic["c_VACUUM_TEST"]] == 1 && _festoDataBuffer["FlowTestClamp"] && AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] > 3500)
  798. {
  799. AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] -= 40;
  800. if (AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] < 14000)
  801. {
  802. AIShorts[AINameIndexDic["r_LOADER_GasFlowSensor_FLOW"]] -= 140;
  803. }
  804. }
  805. }
  806. catch
  807. {
  808. }
  809. }
  810. /// <summary>
  811. /// QDR水位模拟
  812. /// </summary>
  813. private void RinseWaterLevelSimulator()
  814. {
  815. //QDR1
  816. if (_rinse1FillValve && AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] < 25000)
  817. {
  818. AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] += 250;
  819. }
  820. if (_rinse1DumpValve && AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] > 500) //快排
  821. {
  822. AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] -= 600;
  823. }
  824. if (AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] > 500)//慢排
  825. {
  826. AIShorts[AINameIndexDic["r_QDRD1_WATER_LEVEL"]] -= 2;
  827. }
  828. //QDR2
  829. if (_rinse2FillValve && AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] < 25000)
  830. {
  831. AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] += 250;
  832. }
  833. if (_rinse2DumpValve && AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] > 500)
  834. {
  835. AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] -= 600;
  836. }
  837. if (AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] > 500)//慢排
  838. {
  839. AIShorts[AINameIndexDic["r_QDRD2_WATER_LEVEL"]] -= 2;
  840. }
  841. //QDR3
  842. if (_rinse3FillValve && AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] < 25000)
  843. {
  844. AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] += 250;
  845. }
  846. if (_rinse3DumpValve && AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] > 500)
  847. {
  848. AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] -= 600;
  849. }
  850. if (AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] > 500)//慢排
  851. {
  852. AIShorts[AINameIndexDic["r_QDRD3_WATER_LEVEL"]] -= 2;
  853. }
  854. //QDR4
  855. if (_rinse4FillValve && AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] < 25000)
  856. {
  857. AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] += 250;
  858. }
  859. if (_rinse4DumpValve && AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] > 500)
  860. {
  861. AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] -= 600;
  862. }
  863. if (AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] > 500)//慢排
  864. {
  865. AIShorts[AINameIndexDic["r_QDRD4_WATER_LEVEL"]] -= 2;
  866. }
  867. //reservoir1 pump flow
  868. AIShorts[AINameIndexDic["r_PUMP1_FLOW"]] = _reservoir1PumpOn ? (short)6000 : (short)0;
  869. }
  870. /// <summary>
  871. /// metal 2/3/4 pump流量模拟
  872. /// </summary>
  873. private void PumpFlowSimulator()
  874. {
  875. if (DOBytes[DONameIndexDic["c_METAL3_PUMP_ON"]] == 1)
  876. {
  877. AIShorts[AINameIndexDic["r_PUMP3_FLOW"]] = 6000;
  878. }
  879. else
  880. {
  881. AIShorts[AINameIndexDic["r_PUMP3_FLOW"]] = 0;
  882. }
  883. if (DOBytes[DONameIndexDic["c_METAL2_PUMP_ON"]] == 1)
  884. {
  885. AIShorts[AINameIndexDic["r_PUMP2_FLOW"]] = 6000;
  886. }
  887. else
  888. {
  889. AIShorts[AINameIndexDic["r_PUMP2_FLOW"]] = 0;
  890. }
  891. if (DOBytes[DONameIndexDic["c_METAL4_PUMP_ON"]] == 1)
  892. {
  893. AIShorts[AINameIndexDic["r_PUMP4_FLOW"]] = 6000;
  894. }
  895. else
  896. {
  897. AIShorts[AINameIndexDic["r_PUMP4_FLOW"]] = 0;
  898. }
  899. }
  900. /// <summary>
  901. /// Reservoir1 pump流量模拟
  902. /// </summary>
  903. private void Pump1FlowSimulator()
  904. {
  905. if (DONameIndexDic.ContainsKey("c_RESERVOIR1_PUMP_ON") && DOBytes[DONameIndexDic["c_RESERVOIR1_PUMP_ON"]] == 1)
  906. {
  907. SimulatorCommManager.Instance.CheckDataChanged("c_RESERVOIR1_PUMP_ON",true,false);
  908. }
  909. else if (DONameIndexDic.ContainsKey("c_RESERVOIR1_PUMP_ON") && DOBytes[DONameIndexDic["c_RESERVOIR1_PUMP_ON"]] == 0)
  910. {
  911. SimulatorCommManager.Instance.CheckDataChanged("c_RESERVOIR1_PUMP_ON", false, false);
  912. }
  913. }
  914. #endregion
  915. }
  916. }