字节字符串互转

#include <iostream>
#include <stdlib.h>
#include <string.h>
#include <math.h>
#include "TestVerb.h"

using namespace std;

#define STARTWITH     true
#define MEDIAN        false
#define STRINGVALUE   true
#define INTVALUE      false

// 字节数据转换为可打印字符串
// 如：{0xC8, 0x32, 0x9B, 0xFD, 0x0E, 0x01} --> "C8329BFD0E01" 
// 输入: pSrc - 源数据指针
//       nSrcLength - 源数据长度
// 输出: pDst - 目标字符串指针
// 返回: 目标字符串长度
int gsmBytes2String(const unsigned char* pSrc, char* pDst, int nSrcLength)
{
	const char tab[] = "0123456789ABCDEF";	// 0x0-0xf的字符查找表

	for (int i = 0; i < nSrcLength; i++)
	{
		*pDst++ = tab[*pSrc >> 4];		// 输出高4位
		*pDst++ = tab[*pSrc & 0x0f];	// 输出低4位
		pSrc++;
	}

	// 输出字符串加个结束符
	*pDst = '\0';

	// 返回目标字符串长度
	return (nSrcLength * 2);
}

// 可打印字符串转换为字节数据
// 如："C8329BFD0E01" --> {0xC8, 0x32, 0x9B, 0xFD, 0x0E, 0x01}
// 输入: pSrc - 源字符串指针
//       nSrcLength - 源字符串长度
// 输出: pDst - 目标数据指针
// 返回: 目标数据长度
int gsmString2Bytes(const char* pSrc, unsigned char* pDst, int nSrcLength)
{
	for (int i = 0; i < nSrcLength; i += 2)
	{
		// 输出高4位
		if ((*pSrc >= '0') && (*pSrc <= '9'))
		{
			*pDst = (*pSrc - '0') << 4;
		}
		else
		{
			*pDst = (*pSrc - 'A' + 10) << 4;
		}

		pSrc++;

		// 输出低4位
		if ((*pSrc >= '0') && (*pSrc <= '9'))
		{
			*pDst |= *pSrc - '0';
		}
		else
		{
			*pDst |= *pSrc - 'A' + 10;
		}

		pSrc++;
		pDst++;
	}

	// 返回目标数据长度
	return (nSrcLength / 2);
}

long readUint32(unsigned char* pDst, int offset)
{
	return (pDst[offset] & 0xffl) |
		((pDst[offset + 1] & 0xffl) << 8) |
		((pDst[offset + 2] & 0xffl) << 16) |
		((pDst[offset + 3] & 0xffl) << 24);
}

int main(int argc, char* argv[])
{
	//char intSprint[255] = "C8329BFD0E0199999999";//
	char intSprint[255] = "73616665010088b2a905e89ee402ada6624b70c186062ea3606999e43081ade216f00b45e2cfca0000000a02010012201f12288f1df66c44237ed688c5c38acedc01bf4887108eca8ba14dbc376571061880ade2042200";
	unsigned char outBytes[255] = { 0 };
	int szLength = 0;
	int byLength = 0;
	int offset = 0;
	string strReserve = "73616665010088b2a905e89ee402ada6624b70c186062ea3606999e43081ade216f00b45e2cfca0000000a02010012201f12288f1df66c44237ed688c5c38acedc01bf4887108eca8ba14dbc376571061880ade2042200";
	string strCommand = strReserve.substr(76, 8);
	//long i = outBytes[offset] & 0xffl | ((outBytes[offset + 1] & 0xffl) << 8) | ((outBytes[offset + 2] & 0xffl) << 16) | ((outBytes[offset + 3] & 0xffl) << 24);

	byLength = gsmString2Bytes(intSprint, outBytes, strlen(intSprint));
	//unsigned char outTmp[255] = outBytes;
	//strcpy(outTmp, outBytes);
	long i = readUint32(outBytes, 38);
	szLength = gsmBytes2String(outBytes, intSprint, strlen(intSprint) / 2);


	printf("%s\n", intSprint);
	return 0;
}