FietsSimulator.cs 5.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174
  1. using System;
  2. using System.Collections.Generic;
  3. using System.IO.Ports;
  4. using System.Linq;
  5. using System.Text;
  6. using System.Threading.Tasks;
  7. using System.Threading;
  8. using System.Timers;
  9. using System.Diagnostics;
  10. namespace FietsSimulator
  11. {
  12. class FietsSimulator
  13. {
  14. private SerialPort comport;
  15. private Mode curmode;
  16. private int _power, _heartbeat, rpm, speed, distance, energy;
  17. private long maxtime;
  18. private Stopwatch stopwatch;
  19. private Random r = new Random();
  20. public int Power
  21. {
  22. get { return _power; }
  23. set
  24. {
  25. if (value >= 25 && value <= 400)
  26. _power = value;
  27. if (value < 25)
  28. _power = 25;
  29. if (value > 400)
  30. _power = 400;
  31. }
  32. }
  33. public int Heartbeat
  34. {
  35. get { return r.Next(60, 160); }
  36. }
  37. private enum Mode
  38. {
  39. NONE,
  40. CONSOLE,
  41. DISTANCE,
  42. TIME
  43. }
  44. public FietsSimulator(String addr)
  45. {
  46. this.comport = new SerialPort(addr, 9600);
  47. comport.DataReceived += new SerialDataReceivedEventHandler(ReceiveData);
  48. comport.Open();
  49. stopwatch= new Stopwatch();
  50. stopwatch.Stop();
  51. System.Timers.Timer aTimer = new System.Timers.Timer();
  52. aTimer.Elapsed += new ElapsedEventHandler(OnTimedEvent);
  53. aTimer.Interval = 1000;
  54. aTimer.Enabled = true;
  55. }
  56. private void ReceiveData(object sender, SerialDataReceivedEventArgs e)
  57. {
  58. string message = comport.ReadLine().Trim();
  59. Console.WriteLine(message);
  60. if (message == "RS")
  61. {
  62. curmode = Mode.NONE;
  63. rpm = speed = distance = energy = 0;
  64. Power = 25;
  65. stopwatch.Stop();
  66. SendData("ACK");
  67. }
  68. else if (message == "CM" || message == "CU")
  69. {
  70. curmode = Mode.CONSOLE;
  71. SendData("ACK");
  72. }
  73. else if (message.Contains("PD"))
  74. {
  75. if (curmode == Mode.CONSOLE && message.Split().Length == 2)
  76. {
  77. distance = Int32.Parse(message.Split(' ')[1]);
  78. curmode = Mode.DISTANCE;
  79. stopwatch.Reset();
  80. stopwatch.Start();
  81. rpm = 100;
  82. speed = 10;
  83. }
  84. else
  85. {
  86. SendData("ERROR");
  87. }
  88. }
  89. else if (message.Contains("PT"))
  90. {
  91. if (curmode == Mode.CONSOLE && message.Split().Length == 2)
  92. {
  93. string time = message.Split(' ')[1];
  94. maxtime = Int32.Parse(time.Substring(0,2)) * 60000 + Int32.Parse(time.Substring(3,2)) * 1000;
  95. curmode = Mode.TIME;
  96. stopwatch.Reset();
  97. stopwatch.Start();
  98. rpm = 100;
  99. speed = 10;
  100. }
  101. else
  102. {
  103. SendData("ERROR");
  104. }
  105. }
  106. else if (message.Contains("PW"))
  107. {
  108. if (curmode != Mode.NONE && message.Split().Length == 2)
  109. {
  110. this.Power = Int32.Parse(message.Split(' ')[1]);
  111. }
  112. else
  113. {
  114. SendData("ERROR");
  115. }
  116. }
  117. else if (message == "ST" && curmode != Mode.NONE)
  118. {
  119. SendStatus();
  120. }
  121. else
  122. {
  123. SendData("ERROR");
  124. }
  125. }
  126. private void SendData(string message)
  127. {
  128. Console.WriteLine("RETURN:" + message);
  129. this.comport.WriteLine(message);
  130. }
  131. private void SendStatus()
  132. {
  133. SendData(Heartbeat.ToString() + "\t"+rpm +"\t"+speed*10+"\t"+distance+"\t" + Power.ToString() + "\t600\t"+getTimeElapsed()+"\t200\r");
  134. }
  135. private string getTimeElapsed()
  136. {
  137. if(curmode == Mode.DISTANCE)
  138. {
  139. long seconds = (stopwatch.ElapsedMilliseconds / 1000) % 60;
  140. long minutes = ((stopwatch.ElapsedMilliseconds - seconds) / 1000) / 60;
  141. return minutes + ":" + seconds;
  142. }else if(curmode == Mode.TIME)
  143. {
  144. long seconds = ((maxtime - stopwatch.ElapsedMilliseconds) / 1000) % 60;
  145. long minutes = (((maxtime -stopwatch.ElapsedMilliseconds) - seconds) / 1000) / 60;
  146. return minutes + ":" + seconds;
  147. }
  148. else
  149. {
  150. return "00:00";
  151. }
  152. }
  153. private void OnTimedEvent(object source, ElapsedEventArgs e)
  154. {
  155. if(curmode == Mode.DISTANCE)
  156. {
  157. distance -= 1;
  158. }
  159. else if (curmode == Mode.TIME)
  160. {
  161. distance += 1;
  162. }
  163. }
  164. }
  165. }