循环冗余检验(CRC)求帧检验序列(FCS)

#include <stdio.h>
#include <stdint.h>
/**
 *  循环冗余检验(CRC)，求帧检验序列(FCS)
 *  参数：M是待传送的数据
 *        p是除数
 *  返回：帧检验序列(FCS)
 *  说明：都是从0开始编号。
 */
uint32_t getFCS(uint32_t M, uint32_t p) {
    uint32_t tmp;
    uint8_t plen = 0, Mlen = 0;
    int8_t i;

    tmp = p;    //获取p的有效长度
    while (tmp) {
        tmp >>= 1;
        plen++;
    }
    tmp = M;    //获取M的有效长度
    while (tmp) {
        tmp >>= 1;
        Mlen++;
    }

    M <<= (plen - 1);   //得到被除数
    /*
    for (i = Mlen + plen-1 - 1; i >= plen - 1; i--) {
        if (M & (1 << i)) { //如果M的倒数第i位是1
            M ^= p << (i - (plen - 1));
        }
    }
    */
    for (i = Mlen - 1; i >= 0; i--) {
        if (M & (1 << (i + plen - 1))) {
            M ^= p << i;
        }
    }
    return M;
}

void main() {
    printf("%X\n", getFCS(0b101001, 0b1101));       //书上例题
    printf("%X\n", getFCS(0b1101011011, 0b10011));  //课后习题
}