#include "crc.h"
#include <QDebug>
#include "QString"


crc::crc()
{

}

uint8_t crc::crc8(uint8_t *Ptr,uint8_t num)
{

    uint8_t crc = 0;
    uint16_t j,i;

    for (j = 0; j < num; j++)
    {
        crc ^= *(Ptr+j);
        for ( i = 0; i < 8; i++)
        {
            if ((crc & 0x01) != 0)
            {
                crc >>= 1;
                crc ^= 0x8c;
            }
            else
            {
                crc >>= 1;
            }
        }
    }
    return crc;

}




 void crc::crc16(uint8_t *data, int offset, int len,uint8_t *lb,uint8_t *hb)
{
    if (len > 0)
    {
        uint16_t crc = 0xFFFF;
        int i = offset;
        for (; i < len; i++)
        {
            crc = (uint16_t)(crc ^ (data[i]));
            for (int j = 0; j < 8; j++)
            {
                crc = (crc & 1) != 0 ? (uint16_t)((crc >> 1) ^ 0xA001) : (uint16_t)(crc >> 1);
            }
        }
        uint8_t hi = (uint8_t)((crc & 0xFF00) >> 8); //高位置
        uint8_t lo = (uint8_t)(crc & 0x00FF); //低位置
        *lb=lo;*hb=hi;
    }
}


int8_t crc::CheckSumCode(uint8_t CODEMODE, uint8_t *pBuffer, uint16_t Len, uint16_t offset, uint8_t *CHKA, uint8_t *CHKB)
{
    uint16_t i = 0;
    uint8_t _CHKA = 0x00,_CHKB = 0x00;


    for(i=offset;i<Len;i++)
    {
        _CHKA += pBuffer[i];
        _CHKB +=_CHKA;
    }
    if(CODEMODE==DECODE){
        if(_CHKA!=*CHKA)
            return -1;
        if(_CHKB!=*CHKB)
            return -2;
    }
    else{
        *CHKA = _CHKA;

        *CHKB = _CHKB;
    }
    return 0;
}

int crc::CheckSumCode(uint8_t CODEMODE, QByteArray pBuffer, uint16_t Len, uint16_t offset, uint8_t *CHKA, uint8_t *CHKB)
{
    uint16_t i = 0;
    uint8_t _CHKA = 0x00,_CHKB = 0x00;


    for(i=offset;i<Len;i++)
    {
        _CHKA += pBuffer[i];
        _CHKB +=_CHKA;
    }
    if(CODEMODE==DECODE){
        if(_CHKA!=*CHKA)
            return -1;
        if(_CHKB!=*CHKB)
            return -2;
    }
    else{
        *CHKA = _CHKA;

        *CHKB = _CHKB;
    }
    return 0;
}



QString crc::byte_array_to_string(QByteArray data)
{
    QString ret(data.toHex().toUpper());
    int len = ret.length()/2;
    for(int i=1;i<len;i++)
    {
        ret.insert(2*i+i-1," ");
    }

    return ret;
}


// u16转为整形
QString crc::byte_array_to_int_string(QByteArray data)
{
    QString str;
    int len = data.size()/2;
    for(int i=0;i<len;i++)
    {
        str.append(QString::number(data[i*2]|(data[i*2+1]<<8),10));
        str.append(',');
    }

    return str;
}




uint32_t crc::crc32(const QByteArray &data_buf)
{
       uint32_t temp,crc = 0xFFFFFFFF;
       int i,j;
       i = 0;
       ConverBuf cov;
       if((data_buf.size() %4) != 0)
       {
           return 0;
       }
       while(i<data_buf.size())
       {
           cov.c_databuf[0] = data_buf[i++];
           cov.c_databuf[1] = data_buf[i++];
           cov.c_databuf[2] = data_buf[i++];
           cov.c_databuf[3] = data_buf[i++];
           temp = cov.ul_data;
           for(j=0; j<32; j++)
           {
                if( (crc ^ temp) & 0x80000000 )
                {
                    crc = 0x04C11DB7 ^(crc<<1);
                }
                else
                {
                    crc <<=1;
                }
                temp<<=1;
           }
           crc&=0xFFFFFFFF;
       }
       return crc;
}


QString crc::uint8_array_to_string(uint8_t * buf,int len)
{
    QString temp,msg;
    int j = 0;

    while (j<len)
    {
        temp = QString("%1 ").arg((int)buf[j], 2, 16, QLatin1Char('0'));
        msg.append(temp);
        j++;
    }

    return msg;
}