message.go 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153
  1. package protocol
  2. import (
  3. "bytes"
  4. "dlt645-server/errors"
  5. "encoding/binary"
  6. "github.com/gogf/gf/os/glog"
  7. "reflect"
  8. )
  9. // 消息包
  10. type Message struct {
  11. Body Entity
  12. }
  13. type DHeader struct {
  14. MsgID MsgID
  15. }
  16. type Data struct {
  17. DataType int
  18. PowerData
  19. VIData
  20. IData
  21. }
  22. type PowerData struct {
  23. ActivePower float64 `json:"active_power"`
  24. }
  25. type VIData struct {
  26. AV float64 `json:"av"` // A相电压
  27. BV float64 `json:"bv"` // B相电压
  28. CV float64 `json:"cv"` // C相电压
  29. }
  30. type IData struct {
  31. AI float64 `json:"ai"` // A相电流
  32. BI float64 `json:"bi"` // B相电流
  33. CI float64 `json:"ci"` // C相电流
  34. }
  35. // 协议编码
  36. func (message *Message) Encode() ([]byte, error) {
  37. // 编码消息体
  38. var err error
  39. var data []byte
  40. if message.Body != nil && !reflect.ValueOf(message.Body).IsNil() {
  41. data, err = message.Body.Encode(nil)
  42. if err != nil {
  43. return nil, err
  44. }
  45. }
  46. // 二进制转义
  47. buffer := bytes.NewBuffer(nil)
  48. message.write(buffer, data)
  49. return buffer.Bytes(), nil
  50. }
  51. // 协议解码
  52. func (message *Message) Decode(ctx *PacketContext, buf []byte) (data Data, err error) {
  53. // 检验标志位
  54. length := len(buf)
  55. if length == 0 {
  56. return data, errors.ErrInvalidMessage
  57. }
  58. for i := 0; i <= length; i++ {
  59. if buf[i] == SendByte {
  60. continue
  61. } else {
  62. buf = buf[i:length]
  63. glog.Debugf("收到数据:%2X", buf)
  64. break
  65. }
  66. }
  67. if buf[0] != ReceiveByte {
  68. return data, nil
  69. }
  70. if buf[len(buf)-1] != EndByte {
  71. buf = append(buf, 0x16)
  72. }
  73. if !message.checkSum(buf) {
  74. return data, errors.ErrInvalidCheckSum
  75. }
  76. if len(buf) < 8 {
  77. if err != nil {
  78. glog.Errorf("解析报文失败:%s", errors.ErrInvalidBody)
  79. }
  80. }
  81. if buf[8] == 0x93 {
  82. data, err = message.decode(ctx, uint32(0x93), buf[:])
  83. if err != nil {
  84. glog.Errorf("解析报文失败:%s", err.Error())
  85. }
  86. } else {
  87. msgID := MsgID(binary.BigEndian.Uint32(buf[10:15])) //消息ID
  88. data, err = message.decode(ctx, uint32(msgID), buf[:]) //解析实体对象 entity buffer : 为消息标识
  89. if err != nil {
  90. glog.Errorf("解析报文失败:%s", err.Error())
  91. }
  92. }
  93. return data, nil
  94. }
  95. //--->
  96. func (message *Message) decode(ctx *PacketContext, dataType uint32, buf []byte) (data Data, err error) {
  97. creator, ok := entityMapper[dataType]
  98. if !ok {
  99. return data, errors.ErrTypeNotRegistered
  100. }
  101. entity := creator()
  102. data, err = entity.Decode(ctx, buf) //解析data数据
  103. if err != nil {
  104. return data, err
  105. }
  106. return data, err
  107. }
  108. // 写入二进制数据
  109. func (message *Message) write(buffer *bytes.Buffer, data []byte) *Message {
  110. for _, b := range data {
  111. if b == PrefixID {
  112. buffer.WriteByte(EscapeByte)
  113. buffer.WriteByte(EscapeByteSufix2)
  114. } else if b == EscapeByte {
  115. buffer.WriteByte(EscapeByte)
  116. buffer.WriteByte(EscapeByteSufix1)
  117. } else {
  118. buffer.WriteByte(b)
  119. }
  120. }
  121. return message
  122. }
  123. // 和校验
  124. func (message *Message) checkSum(data []byte) bool {
  125. var checkSum byte
  126. for _, b := range data[:len(data)-2] {
  127. checkSum += b
  128. }
  129. checkSum = checkSum & 0xFF
  130. if checkSum == data[len(data)-2] {
  131. return true
  132. }
  133. return false
  134. }