SimDxkdpPower.cs 6.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225
  1. using MECF.Framework.Simulator.Core.Driver;
  2. using System;
  3. using System.Collections.Generic;
  4. using System.Diagnostics;
  5. using System.Linq;
  6. using System.Text;
  7. using System.Threading.Tasks;
  8. using System.Timers;
  9. namespace MECF.Framework.Simulator.Core.RFs.AE
  10. {
  11. class SimDxkdpPower : SerialPortDeviceSimulator
  12. {
  13. public bool Failed { get; set; }
  14. public bool IsOn { get; set; }
  15. public bool IsHalo { get; set; }
  16. public bool IsContinueAck { get; set; }
  17. Stopwatch _timer = new Stopwatch();
  18. private System.Timers.Timer _tick;
  19. Random _rd = new Random();
  20. private object _locker = new object();
  21. public string ResultValue { get; set; }
  22. public SimDxkdpPower(string port)
  23. : base(port, -1, "\r", ' ', false)
  24. {
  25. ResultValue = "";
  26. _tick = new System.Timers.Timer();
  27. _tick.Interval = 200;
  28. _tick.Elapsed += _tick_Elapsed;
  29. _tick.Start();
  30. }
  31. private void _tick_Elapsed(object sender, ElapsedEventArgs e)
  32. {
  33. lock (_locker)
  34. {
  35. if (_timer.IsRunning && _timer.Elapsed > TimeSpan.FromSeconds(10))
  36. {
  37. _timer.Stop();
  38. }
  39. }
  40. }
  41. List<byte> _cached = new List<byte>();
  42. private int _mode;
  43. private int _powerSetPoint;
  44. private byte _vmss = 2;
  45. private byte _cmss = 3;
  46. private UInt16 _voltSetPoint; //未除以 Math.Power(10,_vmss),不做运算,直接用
  47. private UInt16 _currentSetPoint; //未除以 Math.Power(10,_cmss),不做运算,直接用
  48. private UInt16 _setPolarity; //
  49. private UInt16 _volt; //未除以 Math.Power(10,_vmss),不做运算,直接用
  50. private UInt16 _current; //未除以 Math.Power(10,_cmss),不做运算,直接用
  51. private UInt16 _maxVolt = 10000; //未除以 Math.Power(10,_vmss),不做运算,直接用
  52. private UInt16 _maxCurrent = 10000; //未除以 Math.Power(10,_cmss),不做运算,直接用
  53. protected override void ProcessUnsplitMessage(byte[] message1)
  54. {
  55. _cached.AddRange(message1);
  56. if (_cached[0] == 0x06)
  57. _cached.RemoveAt(0);
  58. while(_cached.Count>1 && _cached[0] != 0xAA)
  59. {
  60. _cached.RemoveAt(0);
  61. }
  62. if (_cached.Count < 5 || _cached.Count < (5 + _cached[3]))
  63. return;
  64. byte[] msgIn = _cached.ToArray();
  65. _cached.Clear();
  66. List<byte> lstAck = new List<byte>();
  67. lstAck.Add(0x06);
  68. byte[] response = null;
  69. List<byte> pin = new List<byte>();
  70. switch (msgIn[2])
  71. {
  72. case 0x20:
  73. if (msgIn[4] == 0)
  74. IsOn = false;
  75. else
  76. IsOn = true;
  77. break;
  78. case 0x21:
  79. _voltSetPoint = (UInt16)((msgIn[5] << 8) + msgIn[4]);
  80. _volt = _voltSetPoint;
  81. break;
  82. case 0x22: //
  83. _currentSetPoint = (UInt16)((msgIn[5] << 8) + msgIn[4]);
  84. _current = _currentSetPoint;
  85. break;
  86. case 0x23:
  87. _voltSetPoint = (UInt16)((msgIn[5] << 8) + msgIn[4]);
  88. _currentSetPoint = (UInt16)((msgIn[7] << 8) + msgIn[6]);
  89. _volt = _voltSetPoint;
  90. _current = _currentSetPoint;
  91. break;
  92. case 0x24://
  93. _setPolarity = (UInt16)((msgIn[5] << 8) + msgIn[4]);
  94. break;
  95. case 0x25://
  96. //response = BuildMessage(msgIn[1], msgIn[2], pin.ToArray());
  97. break;
  98. case 0x26: //
  99. byte[] actualVolt = BitConverter.GetBytes(_volt);
  100. byte[] actualCurrent = BitConverter.GetBytes(_current);
  101. pin.AddRange(actualVolt);
  102. pin.AddRange(actualCurrent);
  103. pin.Add(0x00);
  104. response = BuildMessage(msgIn[1], msgIn[2], pin.ToArray());
  105. break;
  106. case 0x27: //
  107. //response = BuildMessage(msgIn[1], msgIn[2], pin.ToArray());
  108. break;
  109. case 0x28: //
  110. byte state = (byte)(IsOn ? 0x01 : 0x00);
  111. byte[] setVolt = BitConverter.GetBytes(_voltSetPoint);
  112. byte[] setCurrent = BitConverter.GetBytes(_currentSetPoint);
  113. pin.Add(state);
  114. pin.AddRange(setVolt);
  115. pin.AddRange(setCurrent);
  116. response = BuildMessage(msgIn[1], msgIn[2], pin.ToArray());
  117. break;
  118. case 0x29://
  119. break;
  120. case 0x2A://
  121. //response = BuildMessage(msgIn[1], msgIn[2], pin.ToArray());
  122. break;
  123. case 0x2B://
  124. byte[] maxVolt = BitConverter.GetBytes(_maxVolt);
  125. byte[] maxCurrent = BitConverter.GetBytes(_maxCurrent);
  126. pin.Add(_vmss);
  127. pin.Add(_cmss);
  128. pin.Add(0x00);
  129. pin.Add(0x00);
  130. pin.Add(0x00);
  131. pin.Add(0x00);
  132. pin.AddRange(maxVolt);
  133. pin.AddRange(maxCurrent);
  134. pin.Add(0x00);
  135. pin.Add(0x00);
  136. pin.Add(0x00);
  137. pin.Add(0x00);
  138. response = BuildMessage(msgIn[1], msgIn[2], pin.ToArray());
  139. break;
  140. case 0x30://
  141. break;
  142. }
  143. if (response != null)
  144. {
  145. OnWriteMessage(response);
  146. }
  147. else
  148. {
  149. OnWriteMessage(lstAck.ToArray());
  150. }
  151. }
  152. private static byte[] BuildMessage(byte address, byte command, byte[] data)
  153. {
  154. List<byte> buffer = new List<byte>();
  155. if (data!=null && data.Length>0)
  156. {
  157. buffer.Add(0xAA);
  158. buffer.Add(address);
  159. buffer.Add(command);
  160. buffer.Add((byte)data.Length);
  161. }
  162. if (data != null && data.Length > 0)
  163. {
  164. buffer.AddRange(data);
  165. }
  166. buffer.Add(CalcSum(buffer.GetRange(1, buffer.Count - 1)));
  167. return buffer.ToArray();
  168. }
  169. private static byte CalcSum(List<byte> data)
  170. {
  171. byte ret = 0x00;
  172. for (var i = 0; i < data.Count; i++)
  173. {
  174. ret += data[i];
  175. }
  176. return ret;
  177. }
  178. }
  179. }