GSM 7bit 编解码

#include <stdio.h> #include <stdlib.h> #include <string.h> int gsmEncode7bit(const char* pSrc, unsigned char* pDst, int nSrcLength); int gsmDecode7bit(const unsigned char* pSrc, char* pDst, int nSrcLength); int main() { char str[] = "123456781234567"; unsigned char dst[30]={0}; char dst_2[30]={0}; int len; int i; len = gsmEncode7bit(str, dst, strlen(str)); printf("%d\n",len); printf("%s\n",str); for(i=0;i<len;i++) printf("%x",dst[i]); printf("\n"); len = gsmDecode7bit(dst, dst_2, len); for(i=0;i<len;i++) printf("%c",dst_2[i]); return 0; } // 7-bit编码 // pSrc: 源字符串指针 // pDst: 目标编码串指针 // nSrcLength: 源字符串长度 // 返回: 目标编码串长度 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; } // 7-bit解码 // pSrc: 源编码串指针 // pDst: 目标字符串指针 // nSrcLength: 源编码串长度 // 返回: 目标字符串长度 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; }