WagoSocketSimulator.cs 46 KB

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