#include "stdafx.h"
#include "Sms.h"
#include "Comm.h"

// 可打印字符串轉換為字節數據
// 如："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);
}

// 字節數據轉換為可打印字符串
// 如：{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);
}

// 7bit編碼
// 輸入: pSrc - 源字符串指針
//       nSrcLength - 源字符串長度
// 輸出: pDst - 目標編碼串指針
// 返回: 目標編碼串長度
int gsmEncode7bit(const char* pSrc, unsigned char* pDst, int nSrcLength)
{
	int nSrc;		// 源字符串的計數值
	int nDst;		// 目標編碼串的計數值
	int nChar;		// 當前正在處理的組內字符字節的序號，范圍是0-7
	unsigned char nLeft;	// 上一字節殘余的數據

	// 計數值初始化
	nSrc = 0;
	nDst = 0;

	// 將源串每8個字節分為一組，壓縮成7個字節
	// 循環該處理過程，直至源串被處理完
	// 如果分組不到8字節，也能正確處理
	while (nSrc < nSrcLength)
	{
		// 取源字符串的計數值的最低3位
		nChar = nSrc & 7;

		// 處理源串的每個字節
		if(nChar == 0)
		{
			// 組內第一個字節，只是保存起來，待處理下一個字節時使用
			nLeft = *pSrc;
		}
		else
		{
			// 組內其它字節，將其右邊部分與殘余數據相加，得到一個目標編碼字節
			*pDst = (*pSrc << (8-nChar)) | nLeft;

			// 將該字節剩下的左邊部分，作為殘余數據保存起來
			nLeft = *pSrc >> nChar;

			// 修改目標串的指針和計數值
			pDst++;
			nDst++;
		}

		// 修改源串的指針和計數值
		pSrc++;
		nSrc++;
	}

	// 返回目標串長度
	return nDst;
}

// 7bit解碼
// 輸入: pSrc - 源編碼串指針
//       nSrcLength - 源編碼串長度
// 輸出: pDst - 目標字符串指針
// 返回: 目標字符串長度
int gsmDecode7bit(const unsigned char* pSrc, char* pDst, int nSrcLength)
{
	int nSrc;		// 源字符串的計數值
	int nDst;		// 目標解碼串的計數值
	int nByte;		// 當前正在處理的組內字節的序號，范圍是0-6
	unsigned char nLeft;	// 上一字節殘余的數據

	// 計數值初始化
	nSrc = 0;
	nDst = 0;
	
	// 組內字節序號和殘余數據初始化
	nByte = 0;
	nLeft = 0;

	// 將源數據每7個字節分為一組，解壓縮成8個字節
	// 循環該處理過程，直至源數據被處理完
	// 如果分組不到7字節，也能正確處理
	while(nSrc<nSrcLength)
	{
		// 將源字節右邊部分與殘余數據相加，去掉最高位，得到一個目標解碼字節
		*pDst = ((*pSrc << nByte) | nLeft) & 0x7f;

		// 將該字節剩下的左邊部分，作為殘余數據保存起來
		nLeft = *pSrc >> (7-nByte);

		// 修改目標串的指針和計數值
		pDst++;
		nDst++;

		// 修改字節計數值
		nByte++;

		// 到了一組的最后一個字節
		if(nByte == 7)
		{
			// 額外得到一個目標解碼字節
			*pDst = nLeft;

			// 修改目標串的指針和計數值
			pDst++;
			nDst++;

			// 組內字節序號和殘余數據初始化
			nByte = 0;
			nLeft = 0;
		}

		// 修改源串的指針和計數值
		pSrc++;
		nSrc++;
	}

	// 輸出字符串加個結束符
	*pDst = '\0';

	// 返回目標串長度
	return nDst;
}

// 8bit編碼
// 輸入: pSrc - 源字符串指針
//       nSrcLength - 源字符串長度
// 輸出: pDst - 目標編碼串指針
// 返回: 目標編碼串長度
int gsmEncode8bit(const char* pSrc, unsigned char* pDst, int nSrcLength)
{
	// 簡單復制
	memcpy(pDst, pSrc, nSrcLength);

	return nSrcLength;
}

// 8bit解碼
// 輸入: pSrc - 源編碼串指針
//       nSrcLength -  源編碼串長度
// 輸出: pDst -  目標字符串指針
// 返回: 目標字符串長度
int gsmDecode8bit(const unsigned char* pSrc, char* pDst, int nSrcLength)
{
	// 簡單復制
	memcpy(pDst, pSrc, nSrcLength);

	// 輸出字符串加個結束符
	*pDst = '\0';

	return nSrcLength;
}

// UCS2編碼
// 輸入: pSrc - 源字符串指針
//       nSrcLength - 源字符串長度
// 輸出: pDst - 目標編碼串指針
// 返回: 目標編碼串長度
int gsmEncodeUcs2(const char* pSrc, unsigned char* pDst, int nSrcLength)
{
	int nDstLength;		// UNICODE寬字符數目
	WCHAR wchar[128];	// UNICODE串緩沖區

	// 字符串-->UNICODE串
	nDstLength = MultiByteToWideChar(CP_ACP, 0, pSrc, nSrcLength, wchar, 128);

	// 高低字節對調，輸出
	for(int i=0; i<nDstLength; i++)
	{
		*pDst++ = wchar[i] >> 8;		// 先輸出高位字節
		*pDst++ = wchar[i] & 0xff;		// 后輸出低位字節
	}

	// 返回目標編碼串長度
	return nDstLength * 2;
}

// UCS2解碼
// 輸入: pSrc - 源編碼串指針
//       nSrcLength -  源編碼串長度
// 輸出: pDst -  目標字符串指針
// 返回: 目標字符串長度
int gsmDecodeUcs2(const unsigned char* pSrc, char* pDst, int nSrcLength)
{
	int nDstLength;		// UNICODE寬字符數目
	WCHAR wchar[128];	// UNICODE串緩沖區

	// 高低字節對調，拼成UNICODE
	for(int i=0; i<nSrcLength/2; i++)
	{
		wchar[i] = *pSrc++ << 8;	// 先高位字節
		wchar[i] |= *pSrc++;		// 后低位字節
	}

	// UNICODE串-->字符串
	nDstLength = WideCharToMultiByte(CP_ACP, 0, wchar, nSrcLength/2, pDst, 160, NULL, NULL);

	// 輸出字符串加個結束符
	pDst[nDstLength] = '\0';

	// 返回目標字符串長度
	return nDstLength;
}

// 正常順序的字符串轉換為兩兩顛倒的字符串，若長度為奇數，補'F'湊成偶數
// 如："8613851872468" --> "683158812764F8"
// 輸入: pSrc - 源字符串指針
//       nSrcLength - 源字符串長度
// 輸出: pDst - 目標字符串指針
// 返回: 目標字符串長度
int gsmInvertNumbers(const char* pSrc, char* pDst, int nSrcLength)
{
	int nDstLength;		// 目標字符串長度
	char ch;			// 用于保存一個字符

	// 復制串長度
	nDstLength = nSrcLength;

	// 兩兩顛倒
	for(int i=0; i<nSrcLength;i+=2)
	{
		ch = *pSrc++;		// 保存先出現的字符
		*pDst++ = *pSrc++;	// 復制后出現的字符
		*pDst++ = ch;		// 復制先出現的字符
	}

	// 源串長度是奇數嗎？
	if(nSrcLength & 1)
	{
		*(pDst-2) = 'F';	// 補'F'
		nDstLength++;		// 目標串長度加1
	}

	// 輸出字符串加個結束符
	*pDst = '\0';

	// 返回目標字符串長度
	return nDstLength;
}