OCSMessage.cs 2.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293
  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 class OCSMessage
  10. {
  11. public enum eKind
  12. {
  13. E, //Error
  14. S, //State
  15. B, //Battery
  16. T, //
  17. C,
  18. P,
  19. I,//수동명령보고,응답
  20. O,
  21. A,//Alive Check
  22. L,
  23. U,
  24. F,
  25. M,//Move
  26. R,
  27. H,
  28. Z,
  29. }
  30. const byte STX = 0x02;
  31. const byte ETX = 0x03;
  32. public string Id { get; set; }
  33. public eKind Kind { get; set; }
  34. //SubCode 만들기 위한 Bool
  35. public bool IsSubCode1 { get; set; } = false;
  36. public bool IsSubCode2 { get; set; } = false;
  37. public bool IsSubCode3 { get; set; } = false;
  38. public string RevID { get; set; }
  39. public string SendID { get; set; }
  40. public string Tag { get; set; }
  41. public string SubCode { get; set; }
  42. public OCSMessage()
  43. {
  44. }
  45. public string LogFormat()
  46. {
  47. return $"{this.Id} - {this.RevID} <- {this.SendID} : kind [{this.Kind.ToString()}] / Tag [{this.Tag}] / SubCode [{this.SubCode}]";
  48. }
  49. string MakeSubcode()
  50. {
  51. StringBuilder sb = new StringBuilder();
  52. sb.Append(this.IsSubCode1 ? "1" : "0");
  53. sb.Append(this.IsSubCode2 ? "1" : "0");
  54. sb.Append(this.IsSubCode3 ? "1" : "0");
  55. return this.SubCode = sb.ToString();
  56. }
  57. public MemoryBuffer ToMemoryBuffer()
  58. {
  59. var mb = new MemoryBuffer(18);
  60. mb.Append(STX);
  61. mb.AppendAscii(RevID);
  62. mb.AppendAscii(SendID);
  63. mb.AppendAscii(this.Kind.ToString());
  64. mb.AppendAscii(this.Tag);
  65. mb.AppendAscii(MakeSubcode());
  66. mb.Append(CheckSum(mb.ToBytes));
  67. mb.Append(ETX);
  68. return mb;
  69. }
  70. byte CheckSum(byte[] bs)
  71. {
  72. byte rb = 0;
  73. foreach( var item in bs)
  74. {
  75. rb += item;
  76. }
  77. return (byte)(rb & 0xff);
  78. }
  79. }
  80. }