OCSMessage.cs 2.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115
  1. using System;
  2. using System.Collections.Generic;
  3. using System.Linq;
  4. using System.Text;
  5. using System.Threading.Tasks;
  6. using GSG.NET.Utils;
  7. namespace OHVConnector
  8. {
  9. public enum eKind
  10. {
  11. Unknown, // Not Define
  12. E, //Error
  13. S, //State
  14. B, //Battery
  15. T, //
  16. C,
  17. P,
  18. I,//수동명령보고,응답
  19. O,
  20. A,//Alive Check
  21. L,
  22. U,
  23. F,
  24. M,//Move
  25. R,
  26. H,
  27. Z,
  28. }
  29. public class OCSMessage
  30. {
  31. const byte STX = 0x02;
  32. const byte ETX = 0x03;
  33. public string Id { get; set; }
  34. public eKind Kind { get; set; }
  35. //SubCode 만들기 위한 Bool
  36. public bool IsSubCode1 { get; set; } = false;
  37. public bool IsSubCode2 { get; set; } = false;
  38. public bool IsSubCode3 { get; set; } = false;
  39. public string RevID { get; set; }
  40. public string SendID { get; set; }
  41. public string Tag { get; set; }
  42. public string SubCode { get; set; }
  43. public byte CheckSum { get; set; }
  44. public OCSMessage()
  45. {
  46. }
  47. public string LogFormat()
  48. {
  49. return $"{this.Id} - {this.RevID} <- {this.SendID} : kind [{this.Kind.ToString()}] / Tag [{this.Tag}] / SubCode [{this.SubCode}]";
  50. }
  51. string MakeSubcode()
  52. {
  53. if ( this.Kind == eKind.A)
  54. {
  55. return this.SubCode;
  56. }
  57. else
  58. {
  59. StringBuilder sb = new StringBuilder();
  60. sb.Append(this.IsSubCode1 ? "1" : "0");
  61. sb.Append(this.IsSubCode2 ? "1" : "0");
  62. sb.Append(this.IsSubCode3 ? "1" : "0");
  63. return this.SubCode = sb.ToString();
  64. }
  65. }
  66. public MemoryBuffer ToMemoryBuffer()
  67. {
  68. var mb = new MemoryBuffer();
  69. mb.Append(STX);
  70. mb.AppendAscii(RevID);
  71. mb.AppendAscii(SendID);
  72. mb.AppendAscii(this.Kind.ToString());
  73. mb.AppendAscii(this.Tag);
  74. mb.AppendAscii(MakeSubcode());
  75. mb.Append(GetCheckSum(mb.ToBytes));
  76. mb.Append(ETX);
  77. return mb;
  78. }
  79. public byte GetCheckSum()
  80. {
  81. var mb = new MemoryBuffer(18);
  82. mb.Append(STX);
  83. mb.AppendAscii(RevID);
  84. mb.AppendAscii(SendID);
  85. mb.AppendAscii(this.Kind.ToString());
  86. mb.AppendAscii(this.Tag);
  87. mb.AppendAscii(MakeSubcode());
  88. return GetCheckSum(mb.ToBytes);
  89. }
  90. byte GetCheckSum(byte[] bs)
  91. {
  92. byte rb = 0;
  93. foreach( var item in bs)
  94. {
  95. rb += item;
  96. }
  97. return (byte)(rb & 0xff);
  98. }
  99. }
  100. }