WhyCan Forum(哇酷开发者社区)

#include "stdint.h"
#include <stdio.h>

#define BIN_LEN 16 //统一长度 ,方便计算 ,但要注意BCD码溢出的问题 
#define BCD_LEN 16 // bcd码最大位数位 BCD_LEN*2，这里为32位

uint8_t bin_arry[BIN_LEN] = { 0 };
uint8_t bcd_arry[BCD_LEN] = { 0 };

void long_bin2bcd(uint8_t* p_bin, uint8_t* p_bcd)
{
    int16_t i;
    uint8_t carry_flag = 0;
    for(i = BIN_LEN * 8; i > 0; i--) {
        carry_flag = p_bin[BIN_LEN - 1] & 0X80 ? 1 : 0;
        for(int8_t j = BIN_LEN - 1; j >= 0; j--) {
            p_bcd[j] <<= 1;
            p_bin[j] <<= 1;
            if(j > 0) {
                if(p_bcd[j - 1] & 0x80) {
                    p_bcd[j] |= 0x01;
                }
                if(p_bin[j - 1] & 0x80) {
                    p_bin[j] |= 0x01;
                }
            }
        }
        p_bcd[0] |= carry_flag;

        if(i > 1) {
            for(int8_t j = 0; j < BIN_LEN; j++) {
                if((p_bcd[j] + 0x03) & 0x08) {
                    p_bcd[j] += 0x03;
                }
                if((p_bcd[j] + 0x30) & 0x80) {
                    p_bcd[j] += 0x30;
                }
            }
        }
    }
    printf("BCD = 0d:");
    for(i = BCD_LEN - 1; i >= 0; i--) {
        printf("%02x", p_bcd[i]);
    }
    printf("\r\n");
}

void long_bcd2bin(uint8_t* p_bin, uint8_t* p_bcd)
{
    int16_t i;
    for(i = BCD_LEN * 8 - 1; i > 0; i--) {
        if(i < BCD_LEN * 8 - 1) {
            for(int8_t j = 0; j < BCD_LEN; j++) {
                if(p_bcd[j] & 0x08) {
                    p_bcd[j] -= 0x03;
                }
                if(p_bcd[j] & 0x80) {
                    p_bcd[j] -= 0x30;
                }
            }
        }

        if(p_bcd[0] & 0x01) {
            p_bin[BCD_LEN - 1] |= 0x80;
        }
        for(int8_t j = 0; j < BCD_LEN; j++) {
            p_bin[j] >>= 1;
            p_bcd[j] >>= 1;
            if(j < BCD_LEN - 1) {
                if(p_bin[j + 1] & 0x01) {
                    p_bin[j] |= 0x80;
                }
                if(p_bcd[j + 1] & 0x01) {
                    p_bcd[j] |= 0x80;
                }
            }
        }
    }
    printf("BIN = 0x:");
    for(i = BIN_LEN - 1; i >= 0; i--) {
        printf("%02x", p_bin[i]);
    }
    printf("\r\n");
}

int main(int argc, char** argv)
{
    bcd_arry[0] = 0x11;
    bcd_arry[1] = 0x22;
    bcd_arry[2] = 0x33;
    bcd_arry[3] = 0x44;
    bcd_arry[4] = 0x55;
    bcd_arry[5] = 0x66;
    bcd_arry[6] = 0x77;
    bcd_arry[7] = 0x88;
    bcd_arry[8] = 0x99;
    bcd_arry[9] = 0x08; // BCD: 8998877665544332211
    long_bcd2bin(bin_arry, bcd_arry);
    for(uint8_t i = 0; i < BIN_LEN; i++) {
        bcd_arry[i] = 0;
    }
    long_bin2bcd(bin_arry, bcd_arry);
    for(uint8_t i = 0; i < BIN_LEN; i++) {
        bcd_arry[i] = bin_arry[i] = 0;
    }
    bin_arry[0] = 0xFF;
    bin_arry[1] = 0xEE;
    bin_arry[2] = 0x33;
    bin_arry[3] = 0x44;
    bin_arry[4] = 0x55;
    bin_arry[5] = 0x66;
    bin_arry[6] = 0x77;
    bin_arry[7] = 0x88;
    bin_arry[8] = 0x99;
    bin_arry[9] = 0x08; // BIN: 0X89988766554433EEFF
    long_bin2bcd(bin_arry, bcd_arry);
    for(uint8_t i = 0; i < BIN_LEN; i++) {
        bin_arry[i] = 0;
    }
    long_bcd2bin(bin_arry, bcd_arry);

    for(uint8_t i = 0; i < BIN_LEN; i++) {
        bcd_arry[i] = bin_arry[i] = 0;
    }
    bin_arry[0] = 0x11;
    bin_arry[1] = 0x22;
    bin_arry[2] = 0x33;
    bin_arry[3] = 0x44;
    bin_arry[4] = 0x55;
    bin_arry[5] = 0x66;
    bin_arry[6] = 0x77;
    bin_arry[7] = 0xAA;
    bin_arry[8] = 0xBB;
    bin_arry[9] = 0xCC;
    bin_arry[10] = 0xDD;
    bin_arry[11] = 0xEE;
    bin_arry[12] = 0xFF; // BIN: 0xFFEEDDCCBBAA77665544332211
    long_bin2bcd(bin_arry, bcd_arry);
    for(uint8_t i = 0; i < BIN_LEN; i++) {
        bin_arry[i] = 0;
    }
    long_bcd2bin(bin_arry, bcd_arry);
    
    return 0;
}