SimSerenRfMatch.cs 8.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304
  1. using MECF.Framework.Simulator.Core.Driver;
  2. using System;
  3. using System.Collections.Generic;
  4. using System.Diagnostics;
  5. using System.Timers;
  6. namespace MECF.Framework.Simulator.Core.RFMatchs
  7. {
  8. class SimSerenRfMatch : SerialPortDeviceSimulator
  9. {
  10. public bool Failed { get; set; }
  11. public bool IsOn { get; set; }
  12. public bool IsHalo { get; set; }
  13. public bool IsContinueAck { get; set; }
  14. Stopwatch _timer = new Stopwatch();
  15. private System.Timers.Timer _tick;
  16. Random _rd = new Random();
  17. private object _locker = new object();
  18. public string ResultValue { get; set; }
  19. public SimSerenRfMatch(string port)
  20. : base(port, -1, "\r", ' ', true)
  21. {
  22. ResultValue = "";
  23. _tick = new System.Timers.Timer();
  24. _tick.Interval = 200;
  25. _tick.Elapsed += _tick_Elapsed;
  26. _tick.Start();
  27. }
  28. private void _tick_Elapsed(object sender, ElapsedEventArgs e)
  29. {
  30. lock (_locker)
  31. {
  32. if (_timer.IsRunning && _timer.Elapsed > TimeSpan.FromSeconds(10))
  33. {
  34. _timer.Stop();
  35. }
  36. }
  37. }
  38. List<byte> _cached = new List<byte>();
  39. private int _mode;
  40. private int _powerSetPoint;
  41. private bool _isLoadAuto;
  42. private bool _isTuneAuto;
  43. private int _tuneSetpoint;
  44. private int _loadSetpoint;
  45. private float _tunePreset;
  46. private float _loadPreset;
  47. private bool _presetEnable = true;
  48. protected override void ProcessUnsplitMessage(string message)
  49. {
  50. switch (message)
  51. {
  52. case "PHS\r":
  53. OnWriteMessage("333\r");
  54. return;
  55. case "QDP\r":
  56. OnWriteMessage("-222\r");
  57. return;
  58. case "QRP\r":
  59. OnWriteMessage("-111\r");
  60. return;
  61. case "MAG\r":
  62. OnWriteMessage("555\r");
  63. return;
  64. case "QPMD\r":
  65. if (_presetEnable)
  66. OnWriteMessage("1\r");
  67. else
  68. {
  69. OnWriteMessage("0\r");
  70. }
  71. return;
  72. case "INT\r":
  73. _presetEnable = true;
  74. OnWriteMessage("\r");
  75. return;
  76. case "OFF\r":
  77. _presetEnable = false;
  78. OnWriteMessage("\r");
  79. return;
  80. case "QP1L\r":
  81. OnWriteMessage($"{_loadPreset*10+1}\r");
  82. return;
  83. case "QP1T\r":
  84. OnWriteMessage($"{_tunePreset * 10+2}\r");
  85. return;
  86. }
  87. if (message == "ALD\r")
  88. {
  89. _isLoadAuto = true;
  90. OnWriteMessage("\r");
  91. return;
  92. }
  93. if (message == "MLD\r")
  94. {
  95. _isLoadAuto = false;
  96. OnWriteMessage("\r");
  97. return;
  98. }
  99. if (message == "MTN\r")
  100. {
  101. _isTuneAuto = false;
  102. OnWriteMessage("\r");
  103. return;
  104. }
  105. if (message.Contains("MVLD"))
  106. {
  107. int.TryParse(message.Replace("MVLD", "").Replace("\r", "").Replace(" ", ""), out _loadSetpoint);
  108. OnWriteMessage("\r");
  109. return;
  110. }
  111. if (message.Contains("MVTN"))
  112. {
  113. int.TryParse(message.Replace("MVTN", "").Replace("\r", "").Replace(" ", ""), out _tuneSetpoint);
  114. OnWriteMessage("\r");
  115. return;
  116. }
  117. if (message == "ATN\r")
  118. {
  119. _isTuneAuto = true;
  120. OnWriteMessage("\r");
  121. return;
  122. }
  123. if (message.Contains("CPLP") || message.Contains("LPS?"))
  124. {
  125. OnWriteMessage($"{_loadSetpoint}\r");
  126. return;
  127. }
  128. if (message.Contains("CPTP") || message.Contains("TPS?"))
  129. {
  130. OnWriteMessage($"{_tuneSetpoint}\r");
  131. return;
  132. }
  133. if (message == ("QAML\r"))
  134. {
  135. if (_isLoadAuto)
  136. OnWriteMessage("A\r");
  137. else
  138. {
  139. OnWriteMessage("M\r");
  140. }
  141. return;
  142. }
  143. if (message == ("QAMT\r"))
  144. {
  145. if (_isLoadAuto)
  146. OnWriteMessage("A\r");
  147. else
  148. {
  149. OnWriteMessage("M\r");
  150. }
  151. return;
  152. }
  153. if (message.Contains("MPL"))
  154. {
  155. var paras = message.Split(' ');
  156. if (paras.Length > 1)
  157. {
  158. float.TryParse(paras[0], out _loadPreset);
  159. }
  160. OnWriteMessage("\r");
  161. }
  162. if (message.Contains("MPT"))
  163. {
  164. var paras = message.Split(' ');
  165. if (paras.Length > 1)
  166. {
  167. float.TryParse(paras[0], out _tunePreset);
  168. }
  169. OnWriteMessage("\r");
  170. }
  171. if (message.Contains("GOTO"))
  172. {
  173. _loadSetpoint = (int)_loadPreset;
  174. _tuneSetpoint = (int)_tunePreset;
  175. OnWriteMessage("\r");
  176. }
  177. OnWriteMessage("\r");
  178. return;
  179. }
  180. protected override void ProcessUnsplitMessage(byte[] message1)
  181. {
  182. _cached.AddRange(message1);
  183. if (_cached[0] == 0x06)
  184. _cached.RemoveAt(0);
  185. if (_cached.Count < 3)
  186. return;
  187. byte[] msgIn = _cached.ToArray();
  188. _cached.Clear();
  189. List<byte> lstAck = new List<byte>();
  190. lstAck.Add(0x06);
  191. switch (msgIn[1])
  192. {
  193. case 1:
  194. IsOn = false;
  195. break;
  196. case 2:
  197. IsOn = true;
  198. break;
  199. case 3: //reg mode
  200. _mode = msgIn[2];
  201. break;
  202. case 8:
  203. _powerSetPoint = msgIn[2] + (msgIn[3] << 8);
  204. break;
  205. case 155://mode comm
  206. //response = BuildMessage((byte)(msgIn[0] >> 3), msgIn[1], new byte[] { 0x8 });
  207. break;
  208. case 162://status
  209. //response = BuildMessage((byte)(msgIn[0] >> 3), msgIn[1], new byte[] { IsOn ? (byte)0x40 : (byte)0, 0, 0, 0 });
  210. break;
  211. case 164: //setpoint
  212. //response = BuildMessage((byte)(msgIn[0] >> 3), msgIn[1], new byte[] { (byte)_powerSetPoint, (byte)(_powerSetPoint >> 8), (byte)_mode });
  213. break;
  214. case 165: //forward
  215. int forward = (int)(_powerSetPoint * 0.8);
  216. //response = BuildMessage((byte)(msgIn[0] >> 3), msgIn[1], new byte[] { (byte)forward, (byte)(forward >> 8) });
  217. break;
  218. case 166: //reflect
  219. int reflect = (int)(_powerSetPoint * 0.2);
  220. //response = BuildMessage((byte)(msgIn[0] >> 3), msgIn[1], new byte[] { (byte)reflect, (byte)(reflect >> 8) });
  221. break;
  222. case 221://pin
  223. List<byte> pin = new List<byte>();
  224. for (int i = 0; i < 32; i++)
  225. {
  226. if (i == 20 && IsHalo)
  227. {
  228. pin.Add(0x31);
  229. continue;
  230. }
  231. pin.Add(0);
  232. }
  233. //response = BuildMessage((byte)(msgIn[0] >> 3), msgIn[1], pin.ToArray());
  234. break;
  235. }
  236. if (!IsContinueAck)
  237. {
  238. OnWriteMessage(lstAck.ToArray());
  239. //OnWriteMessage(response);
  240. }
  241. else
  242. {
  243. //lstAck.AddRange(response);
  244. OnWriteMessage(lstAck.ToArray());
  245. }
  246. }
  247. }
  248. }