#include "utils.h"

/*
生成多项式 (x^16 + x^15 + x^2 + 1）
*/
uint16_t modbus_crc16(uint8_t* data, int length)
{

    uint16_t crc = 0xFFFF;  // 初始值FFFF
    uint16_t polynomial = 0x8005;  // 多项式8005

    for (int  i = 0; i < length; i++) {
        // 输入反转(REFIN)：对每个字节进行位反转
        uint8_t byte = data[i];
        uint8_t reversed_byte = 0;

        for (int j = 0; j < 8; j++) {
            reversed_byte = (reversed_byte << 1) | (byte & 0x01);
            byte >>= 1;
        }

        crc ^= (reversed_byte << 8);  // 与高字节异或

        for (int j = 0; j < 8; j++) {
            if (crc & 0x8000) {  // 检查最高位
                crc = (crc << 1) ^ polynomial;
            } else {
                crc <<= 1;
            }
        }
    }

    // 输出反转(REFOUT)：对16位CRC结果进行位反转
    uint16_t reversed_crc = 0;

    for (int i = 0; i < 16; i++) {
        reversed_crc = (reversed_crc << 1) | (crc & 0x0001);
        crc >>= 1;
    }

    // 结果异或值(XOROUT)：0000（实际不变）
    return reversed_crc ^ 0x0000;
}