#include <string.h>
#include <stddef.h>
#include <locale.h>
#include <stdlib.h>
#include "pdu.h"
/**
* 可打印字符串转换为字节数据
* 如："C8329BFD0E01" --> {0xC8, 0x32, 0x9B, 0xFD, 0x0E, 0x01}
*@ pSrc - 源字符串指针
*@ nSrcLength - 源字符串长度
*@ pDst - 目标数据指针
*return: 目标数据长度
*/
int string2bytes(const char* pSrc, unsigned char* pDst, int nSrcLength)
{
int i;
for (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 - 目标字符串指针
*return -目标字符串长度
*/
int bytes2string(const unsigned char* pSrc, char* pDst, int nSrcLength)
{
const char tab[]="0123456789ABCDEF"; /* 0x0-0xf的字符查找表*/
int i;
for (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 - 目标编码串指针
*return: 目标编码串长度
*/
int encode_7bit(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 decode_7bit(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 encode_8bit(const char* pSrc, unsigned char* pDst, int nSrcLength)
{
// 简单复制
memcpy(pDst, pSrc, nSrcLength);
return nSrcLength;
}
// 8bit解码
// 输入: pSrc - 源编码串指针
// nSrcLength - 源编码串长度
// 输出: pDst - 目标字符串指针
// 返回: 目标字符串长度
int decode_8bit(const unsigned char* pSrc, char* pDst, int nSrcLength)
{
// 简单复制
memcpy(pDst, pSrc, nSrcLength);
// 输出字符串加个结束符
*pDst = '\0';
return nSrcLength;
}
/**
*@ desbuf - the buf to store the encoded string
*@ srcbuf -the UTF-8 string you want to encode, its lenth <=255
*RETURN -the encoded length of desbuf
*/
int encode_UCS2(char *desbuf, const char *srcbuf)
{
int len,i,j=0;
wchar_t wcbuf[255];
setlocale(LC_ALL,"");
/* convert mutibytes string to wide charater string */
len = mbstowcs(wcbuf, srcbuf, 255);
for (i=0;i<len;i++)
{
desbuf[j++] = wcbuf[i]>>8; /* height byte */
desbuf[j++] = wcbuf[i]&0xff; /* low byte */
}
return len*2 ;
}
/**
*@ srcbuf - source UCS-2 string you want to decode
*@ desbuf - destination buf to store the decoded string
*@ desbuflen - the lenth of desbuf, must <=255
*RETURN - the length of decoded string
*/
int decode_UCS2(char *desbuf, const char *srcbuf, int desbuflen)
{
wchar_t wcbuf[255];
int deslen;
int i;
setlocale(LC_ALL,"");
for( i=0;i < desbuflen/2;i++ )
{
wcbuf[i] = *srcbuf++ << 8;
wcbuf[i] |= *srcbuf++;
}
/* convert wide charater string to mutibytes string */
deslen = wcstombs((char *)desbuf,wcbuf,desbuflen);
desbuf[deslen] = '\0';
return deslen;
}
// 正常顺序的字符串转换为两两颠倒的字符串，若长度为奇数，补'F'凑成偶数
// 如："8613851872468" --> "683158812764F8"
// 输入: pSrc - 源字符串指针
// nSrcLength - 源字符串长度
// 输出: pDst - 目标字符串指针
// 返回: 目标字符串长度
int invert_numbers(const char* pSrc, char* pDst, int nSrcLength)
{
int nDstLength; // 目标字符串长度
char ch; // 用于保存一个字符
// 复制串长度
nDstLength = nSrcLength;
// 两两颠倒
int i;
for(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;
}
// 两两颠倒的字符串转换为正常顺序的字符串
// 如："683158812764F8" --> "8613851872468"
// 输入: pSrc - 源字符串指针
// nSrcLength - 源字符串长度
// 输出: pDst - 目标字符串指针
// 返回: 目标字符串长度
int serialize_numbers(const char* pSrc, char* pDst, int nSrcLength)
{
int nDstLength; // 目标字符串长度
char ch; // 用于保存一个字符
// 复制串长度
nDstLength = nSrcLength;
// 两两颠倒
int i;
for(i=0; i<nSrcLength;i+=2)
{
ch = *pSrc++; // 保存先出现的字符
*pDst++ = *pSrc++; // 复制后出现的字符
*pDst++ = ch; // 复制先出现的字符
}
// 最后的字符是'F'吗？
if(*(pDst-1) == 'F')
{
pDst--;
nDstLength--; // 目标字符串长度减1
}
// 输出字符串加个结束符
*pDst = '\0';
// 返回目标字符串长度
return nDstLength;
}
// PDU编码，用于编制、发送短消息
// 输入: pSrc - 源PDU参数指针
// 输出: pDst - 目标PDU串指针
// 返回: 目标PDU串长度
int encode_PDU(const smsopt *pSrc, char *pDst)
{
int nLength; // 内部用的串长度
int nDstLength; // 目标PDU串长度
unsigned char buf[256]; // 内部用的缓冲区
// SMSC地址信息段
nLength = strlen(pSrc->SCA); // SMSC地址字符串的长度
buf[0] = (char)((nLength & 1) == 0 ? nLength : nLength + 1) / 2 + 1; // SMSC地址信息长度
buf[1] = 0x91; // 固定: 用国际格式号码
nDstLength = bytes2string(buf, pDst, 2); // 转换2个字节到目标PDU串
nDstLength += invert_numbers(pSrc->SCA, &pDst[nDstLength], nLength); // 转换SMSC号码到目标PDU串
// TPDU段基本参数、目标地址等
nLen
