#include "codec.h"

class CodecYm : public Codec
{
  Q_OBJECT
public:
  CodecYm() : Codec()
  {
    is_big_data = false;
    num_to_read = 0;
  }
  ~CodecYm() {}
  // 重载接收字节函数
  bool recvByte(int byte)
  {
    bool ack = false;
    if (fullFrame == true)
    {
      return fullFrame;
    }
    data.append(uint8_t(byte));
    switch (data.size())
    {
    case 2:
      if (uint8_t(data[0]) == 0x59u && uint8_t(data[1]) == 0x6du)
      {
        is_big_data = false;
        num_to_read = 4; // 帧头+2byte负载长度
      }
      else
      {
        data.remove(0, 1);
        num_to_read = 0;
      }
      break;
    case 4:
    {
      int len = data[2] | (data[3] << 8);
      if (len < 65535)
      {
        is_big_data = false;
        num_to_read += len + 2; // 负载+2byte校验
        qDebug("normal data. len=%d", len);
      }
      else
      {
        is_big_data = true;
        num_to_read = 11; // 扩展数据长度
        qDebug("big data.");
      }
    }
    break;
    case 11:
    {
      if (is_big_data == true)
      {
        int len = data[7] | (data[8] << 8) | (data[9] << 16) | (data[10] << 24);
        num_to_read = 4 + len + 2; // 负载+2byte校验
        qDebug("big data. len=%d", len);
      }
    }
    default:
      break;
    }
    // 此时一帧数据已完成
    if (num_to_read > 0 && num_to_read == data.size())
    {
      ack = true;
      num_to_read = 0;
    }

    fullFrame = ack;
    return fullFrame;
  }
  // 重载解码函数
  QByteArray decode(int &srcAddr, int &dstAddr, int &cmd, QByteArray data)
  {
    Q_UNUSED(srcAddr);
    Q_UNUSED(dstAddr);
    QByteArray r;
    if (data.size() < 9)
    {
      // 主机一帧数据至少9字节
      qWarning("recv data len too less");
      return r;
    }

    if ((uint8_t(data[0]) != 0x59u) || (uint8_t(data[1]) != 0x6du))
    {
      // 帧头不对
      qWarning("frame head not 0x59 0x6d");
      return r;
    }

    int len = (data[2] | (data[3] << 8));
    if (len == 65535)
    {
      // 重新设置数据长度
      len = data[7] | (data[8] << 8) | (data[9] << 16) | (data[10] << 24);
      is_big_data = true;
    }
    else
    {
      is_big_data = false;
    }
    if (len + 6 != data.size())
    {
      // 如果长度不相等则产生了数据丢失
      qWarning("recv data have lossed");
      return r;
    }
    uint8_t chk_a = 0, chk_b = 0;
    // crc::crc16((uint8_t *)data.data(),2,len+4,&chk_a,&chk_b);
    if (chk_a != uint8_t(data[data.size() - 2]) || chk_b != uint8_t(data[data.size() - 1]))
    {
      // crc校验不对
      qWarning("recv data check error:%02x,%02x %02x,%02x", chk_a, chk_b, int(data[data.size() - 2]),
               int(data[data.size() - 1]));
    }
    // 保存此流水号
    cmd_no = data[5] | (data[6] << 8);
    cmd = data[4];
    // 数据负载
    if (is_big_data == false)
      r = data.mid(7, len - 3);
    else
      r = data.mid(11, len - 7);
    return r;
  }

private:
  bool is_big_data;
  int num_to_read;
  int cmd_no;
};