gsmdecode7bit.c

来自「GSM短信息7-bit解码程序」· C语言 代码 · 共 58 行

#include <my.h>
//7-bit解码
//用于单片机控制手机模块进行GSM短信息7-bit解码。
//pSrc:源编码串指针
//pDst:目标编码串指针
//nSrcLength:源编码串长度
//返回:目标字符串长度
//pSrc:源字符串指针
//pDst:目标数据指针
//nSrcLength:源字符串长度
//返回:目标数据长度
uint gsmDecode7bit(const uchar *pSrc,uchar *pDst,uint nSrcLength)
{
 uint nSrc;
 uint nDst;
 uint nByte;
 uchar nLeft;
 nSrc=0;
 nDst=0;
 nByte=0;
 nLeft=0;
 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;
}
uint gsmBytes2String(const uchar *pSrc,uchar *pDst,uint nSrcLength)
{
 uint i;
 const uchar tab[]="0123456789ABCDEF";
 for(i=0;i<nSrcLength;i++)
 {
  *pDst++=tab[*pSrc>>4];
  *pDst++=tab[*pSrc&0x0f];
  pSrc++;
 }
 *pDst='\0';
 return nSrcLength*2;
}