c++ 十進制、十六進制和BCD的相互轉換

#include <stdio.h>
#include <string.h>
#include <iostream>
using namespace std;
/////////////////////////////////////////////////////
//
//功能：二進制取反
//
//輸入：const unsigned char *src  二進制數據
//      int length                待轉換的二進制數據長度
//
//輸出：unsigned char *dst        取反后的二進制數據
//
//返回：0    success
//
//////////////////////////////////////////////////////
int convert(unsigned char *dst, const unsigned char *src, int length)
{
    int i;
    for (i = 0; i < length; i++)
    {
        dst[i] = src[i] ^ 0xFF;
    }
    return 0;
}
//////////////////////////////////////////////////////////
//
//功能：十六進制轉為十進制
//
//輸入：const unsigned char *hex         待轉換的十六進制數據
//      int length                       十六進制數據長度
//
//輸出：
//
//返回：int  rslt                        轉換后的十進制數據
//
//思路：十六進制每個字符位所表示的十進制數的范圍是0 ~255，進制為256
//      左移8位(<<8)等價乘以256
//
/////////////////////////////////////////////////////////
unsigned long HextoDec(const unsigned char *hex, int length)
{
    int i;
    unsigned long rslt = 0;
    for (i = 0; i < length; i++)
    {
        rslt += (unsigned long)(hex[i]) << (8 * (length - 1 - i));

    }
    return rslt;
}

/////////////////////////////////////////////////////////
//
//功能：十進制轉十六進制
//
//輸入：int dec                     待轉換的十進制數據
//      int length                  轉換后的十六進制數據長度
//
//輸出：unsigned char *hex          轉換后的十六進制數據
//
//返回：0    success
//
//思路：原理同十六進制轉十進制
//////////////////////////////////////////////////////////
int DectoHex(int dec, unsigned char *hex, int length)
{
    int i;
    for (i = length - 1; i >= 0; i--)
    {
        hex[i] = (dec % 256) & 0xFF;
        dec /= 256;
    }
    return 0;
}
/////////////////////////////////////////////////////////
//
//功能：求權
//
//輸入：int base                    進制基數
//      int times                   權級數
//
//輸出：
//
//返回：unsigned long               當前數據位的權
//
//////////////////////////////////////////////////////////
unsigned long power(int base, int times)
{
    int i;
    unsigned long rslt = 1;
    for (i = 0; i < times; i++)
        rslt *= base;
    return rslt;
}
/////////////////////////////////////////////////////////
//
//功能：BCD轉10進制
//
//輸入：const unsigned char *bcd     待轉換的BCD碼
//      int length                   BCD碼數據長度
//
//輸出：
//
//返回：unsigned long               當前數據位的權
//
//思路：壓縮BCD碼一個字符所表示的十進制數據范圍為0 ~ 99,進制為100
//      先求每個字符所表示的十進制值，然后乘以權
//////////////////////////////////////////////////////////
unsigned long  BCDtoDec(const unsigned char *bcd, int length)
{
    int i, tmp;
    unsigned long dec = 0;
    for (i = 0; i < length; i++)
    {
        tmp = ((bcd[i] >> 4) & 0x0F) * 10 + (bcd[i] & 0x0F);
        dec += tmp * power(100, length - 1 - i);
    }
    return dec;
}
/////////////////////////////////////////////////////////
//
//功能：十進制轉BCD碼
//
//輸入：int Dec                      待轉換的十進制數據
//      int length                   BCD碼數據長度
//
//輸出：unsigned char *Bcd           轉換后的BCD碼
//
//返回：0  success
//
//思路：原理同BCD碼轉十進制
//
//////////////////////////////////////////////////////////
int DectoBCD(int Dec, unsigned char *Bcd, int length)
{
    int i;
    int temp;
    for (i = length - 1; i >= 0; i--)
    {
        temp = Dec % 100;
        Bcd[i] = ((temp / 10) << 4) + ((temp % 10) & 0x0F);
        Dec /= 100;
    }
    return 0;
}
//main函數
int main(int argc, char** argv)
{
    //BCD碼轉十進制
    unsigned char BCD[3] = { 0x00, 0x53, 0x20 };
    int dec_bcd = BCDtoDec(BCD, 3);
    cout << "dec_bcd : " << dec_bcd << endl;

    //十進制轉BCD碼
    unsigned char tmp_bff[3] = "";
    DectoBCD(dec_bcd, tmp_bff, 3);
    for (int i = 0; i < 3; ++i)
    {
        //cout << "tmp_buff[" << i << "]: " << tmp_bff[i] << endl;
        printf("tmp_bff[%d] = 0x%02X\n", i, tmp_bff[i]);
    }

    cout << endl << endl;
    //十六進制轉十進制
    unsigned char Hex[3] = { 0x00, 0x53, 0x20 };
    int dec_hex = HextoDec(Hex, 3);
    cout << "dec_hex: " << dec_hex << endl;

    //十進制轉十六進制
    unsigned char hex_bff[3] = "";
    DectoHex(dec_hex, hex_bff, 3);
    for (int i = 0; i < 3; ++i)
    {
        printf("hex_bff[%d] = 0x%02X\n", i, hex_bff[i]);
    }

    system("pause");
    return 0;
}